1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808380938103811381238133814381538163817381838193820382138223823382438253826382738283829383038313832383338343835383638373838383938403841384238433844384538463847384838493850385138523853385438553856385738583859386038613862386338643865386638673868386938703871387238733874387538763877387838793880388138823883388438853886388738883889389038913892389338943895389638973898389939003901390239033904390539063907390839093910391139123913391439153916391739183919392039213922392339243925392639273928392939303931393239333934393539363937393839393940394139423943394439453946394739483949395039513952395339543955395639573958395939603961396239633964396539663967396839693970397139723973397439753976397739783979398039813982398339843985398639873988398939903991399239933994399539963997399839994000400140024003400440054006400740084009401040114012401340144015401640174018401940204021402240234024402540264027402840294030403140324033403440354036403740384039404040414042404340444045404640474048404940504051405240534054405540564057405840594060406140624063406440654066406740684069407040714072407340744075407640774078407940804081408240834084408540864087408840894090409140924093409440954096409740984099410041014102410341044105410641074108410941104111411241134114411541164117411841194120412141224123412441254126412741284129413041314132413341344135413641374138413941404141414241434144414541464147414841494150415141524153415441554156415741584159416041614162416341644165416641674168416941704171417241734174417541764177417841794180418141824183418441854186418741884189419041914192419341944195419641974198419942004201420242034204420542064207420842094210421142124213421442154216421742184219422042214222422342244225422642274228422942304231423242334234423542364237423842394240424142424243424442454246424742484249425042514252425342544255425642574258425942604261426242634264426542664267426842694270427142724273427442754276427742784279428042814282428342844285428642874288428942904291429242934294429542964297429842994300430143024303430443054306430743084309431043114312431343144315431643174318431943204321432243234324432543264327432843294330433143324333433443354336433743384339434043414342434343444345434643474348434943504351435243534354435543564357435843594360436143624363436443654366436743684369437043714372437343744375437643774378437943804381438243834384438543864387438843894390439143924393439443954396439743984399440044014402440344044405440644074408440944104411441244134414441544164417441844194420442144224423442444254426442744284429443044314432443344344435443644374438443944404441444244434444444544464447444844494450445144524453445444554456445744584459446044614462446344644465446644674468446944704471447244734474447544764477447844794480448144824483448444854486448744884489449044914492449344944495449644974498449945004501450245034504450545064507450845094510451145124513451445154516451745184519452045214522452345244525452645274528452945304531453245334534453545364537453845394540454145424543454445454546454745484549455045514552455345544555455645574558455945604561456245634564456545664567456845694570457145724573457445754576457745784579458045814582458345844585458645874588458945904591459245934594459545964597459845994600460146024603460446054606460746084609461046114612461346144615461646174618461946204621462246234624462546264627462846294630463146324633463446354636463746384639464046414642464346444645464646474648464946504651465246534654465546564657465846594660466146624663466446654666466746684669467046714672467346744675467646774678467946804681468246834684468546864687468846894690469146924693469446954696469746984699470047014702470347044705470647074708470947104711471247134714471547164717471847194720472147224723472447254726472747284729473047314732473347344735473647374738473947404741474247434744474547464747474847494750475147524753475447554756475747584759476047614762476347644765476647674768476947704771477247734774477547764777477847794780478147824783478447854786478747884789479047914792479347944795479647974798479948004801480248034804480548064807480848094810481148124813481448154816481748184819482048214822482348244825482648274828482948304831483248334834483548364837483848394840484148424843484448454846484748484849485048514852485348544855485648574858485948604861486248634864486548664867486848694870487148724873487448754876487748784879488048814882488348844885488648874888488948904891489248934894489548964897489848994900490149024903490449054906490749084909491049114912491349144915491649174918491949204921492249234924492549264927492849294930493149324933493449354936493749384939494049414942494349444945494649474948494949504951495249534954495549564957495849594960496149624963496449654966496749684969497049714972497349744975497649774978497949804981498249834984498549864987498849894990499149924993499449954996499749984999500050015002500350045005500650075008500950105011501250135014501550165017501850195020502150225023502450255026502750285029503050315032503350345035503650375038503950405041504250435044504550465047504850495050505150525053505450555056505750585059506050615062506350645065506650675068506950705071507250735074507550765077507850795080508150825083508450855086508750885089509050915092509350945095509650975098509951005101510251035104510551065107510851095110511151125113511451155116511751185119512051215122512351245125512651275128512951305131513251335134513551365137513851395140514151425143514451455146514751485149515051515152515351545155515651575158515951605161516251635164516551665167516851695170517151725173517451755176517751785179518051815182518351845185518651875188518951905191519251935194519551965197519851995200520152025203520452055206520752085209521052115212521352145215521652175218521952205221522252235224522552265227522852295230523152325233523452355236523752385239524052415242524352445245524652475248524952505251525252535254525552565257525852595260526152625263526452655266526752685269527052715272527352745275527652775278527952805281528252835284528552865287528852895290529152925293529452955296529752985299530053015302530353045305530653075308530953105311531253135314531553165317531853195320532153225323532453255326532753285329533053315332533353345335533653375338533953405341534253435344534553465347534853495350535153525353535453555356535753585359536053615362536353645365536653675368536953705371537253735374537553765377537853795380538153825383538453855386538753885389539053915392539353945395539653975398539954005401540254035404540554065407540854095410541154125413541454155416541754185419542054215422542354245425542654275428542954305431543254335434543554365437543854395440544154425443544454455446544754485449545054515452545354545455545654575458545954605461546254635464546554665467546854695470547154725473547454755476547754785479548054815482548354845485548654875488548954905491549254935494549554965497549854995500550155025503550455055506550755085509551055115512551355145515551655175518551955205521552255235524552555265527552855295530553155325533553455355536553755385539554055415542554355445545554655475548554955505551555255535554555555565557555855595560556155625563556455655566556755685569557055715572557355745575557655775578557955805581558255835584558555865587558855895590559155925593559455955596559755985599560056015602560356045605560656075608560956105611561256135614561556165617561856195620562156225623562456255626562756285629563056315632563356345635563656375638563956405641564256435644564556465647564856495650565156525653565456555656565756585659566056615662566356645665566656675668566956705671567256735674567556765677567856795680568156825683568456855686568756885689569056915692569356945695569656975698569957005701570257035704570557065707570857095710571157125713571457155716571757185719572057215722572357245725572657275728572957305731573257335734573557365737573857395740574157425743574457455746574757485749575057515752575357545755575657575758575957605761576257635764576557665767576857695770577157725773577457755776577757785779578057815782578357845785578657875788578957905791579257935794579557965797579857995800580158025803580458055806580758085809581058115812581358145815581658175818581958205821582258235824582558265827582858295830583158325833583458355836583758385839584058415842584358445845584658475848584958505851585258535854585558565857585858595860586158625863586458655866586758685869587058715872587358745875587658775878587958805881588258835884588558865887588858895890589158925893589458955896589758985899590059015902590359045905590659075908590959105911591259135914591559165917591859195920592159225923592459255926592759285929593059315932593359345935593659375938593959405941594259435944594559465947594859495950595159525953595459555956595759585959596059615962596359645965596659675968596959705971597259735974597559765977597859795980598159825983598459855986598759885989599059915992599359945995599659975998599960006001600260036004600560066007600860096010601160126013601460156016601760186019602060216022602360246025602660276028602960306031603260336034603560366037603860396040604160426043604460456046604760486049605060516052605360546055605660576058605960606061606260636064606560666067606860696070607160726073607460756076607760786079608060816082608360846085608660876088608960906091609260936094609560966097609860996100610161026103610461056106610761086109611061116112611361146115611661176118611961206121612261236124612561266127612861296130613161326133613461356136613761386139614061416142614361446145614661476148614961506151615261536154615561566157615861596160616161626163616461656166616761686169617061716172617361746175617661776178617961806181618261836184618561866187618861896190619161926193619461956196619761986199620062016202620362046205620662076208620962106211621262136214621562166217621862196220622162226223622462256226622762286229623062316232623362346235623662376238623962406241624262436244624562466247624862496250625162526253625462556256625762586259626062616262626362646265626662676268626962706271627262736274627562766277627862796280628162826283628462856286628762886289629062916292629362946295629662976298629963006301630263036304630563066307630863096310631163126313631463156316631763186319632063216322632363246325632663276328632963306331633263336334633563366337633863396340634163426343634463456346634763486349635063516352635363546355635663576358635963606361636263636364636563666367636863696370637163726373637463756376637763786379638063816382638363846385638663876388638963906391639263936394639563966397639863996400640164026403640464056406640764086409641064116412641364146415641664176418641964206421642264236424642564266427642864296430643164326433643464356436643764386439644064416442644364446445644664476448644964506451645264536454645564566457645864596460646164626463646464656466646764686469647064716472647364746475647664776478647964806481648264836484648564866487648864896490649164926493649464956496649764986499650065016502650365046505650665076508650965106511651265136514651565166517651865196520652165226523652465256526652765286529653065316532653365346535653665376538653965406541654265436544654565466547654865496550655165526553655465556556655765586559656065616562656365646565656665676568656965706571657265736574657565766577657865796580658165826583658465856586658765886589659065916592659365946595659665976598659966006601660266036604660566066607660866096610661166126613661466156616661766186619662066216622662366246625662666276628662966306631663266336634663566366637663866396640664166426643664466456646664766486649665066516652665366546655665666576658665966606661666266636664666566666667666866696670667166726673667466756676667766786679668066816682668366846685668666876688668966906691669266936694669566966697669866996700670167026703670467056706670767086709671067116712671367146715671667176718671967206721672267236724672567266727672867296730673167326733673467356736673767386739674067416742674367446745674667476748674967506751675267536754675567566757675867596760676167626763676467656766676767686769677067716772677367746775677667776778677967806781678267836784678567866787678867896790679167926793679467956796679767986799680068016802680368046805680668076808680968106811681268136814681568166817681868196820682168226823682468256826682768286829683068316832683368346835683668376838683968406841684268436844684568466847684868496850685168526853685468556856685768586859686068616862686368646865686668676868686968706871687268736874687568766877687868796880688168826883688468856886688768886889689068916892689368946895689668976898689969006901690269036904690569066907690869096910691169126913691469156916691769186919692069216922692369246925692669276928692969306931693269336934693569366937693869396940694169426943694469456946694769486949695069516952695369546955695669576958695969606961696269636964696569666967696869696970697169726973697469756976697769786979698069816982698369846985698669876988698969906991699269936994699569966997699869997000700170027003700470057006700770087009701070117012701370147015701670177018701970207021702270237024702570267027702870297030703170327033703470357036703770387039704070417042704370447045704670477048704970507051705270537054705570567057705870597060706170627063706470657066706770687069707070717072707370747075707670777078707970807081708270837084708570867087708870897090709170927093709470957096709770987099710071017102710371047105710671077108710971107111711271137114711571167117711871197120712171227123712471257126712771287129713071317132713371347135713671377138713971407141714271437144714571467147714871497150715171527153715471557156715771587159716071617162716371647165716671677168716971707171717271737174717571767177717871797180718171827183718471857186718771887189719071917192719371947195719671977198719972007201720272037204720572067207720872097210721172127213721472157216721772187219722072217222722372247225722672277228722972307231723272337234723572367237723872397240724172427243724472457246724772487249725072517252725372547255725672577258725972607261726272637264726572667267726872697270727172727273727472757276727772787279728072817282728372847285728672877288728972907291729272937294729572967297729872997300730173027303730473057306730773087309731073117312731373147315731673177318731973207321732273237324732573267327732873297330733173327333733473357336733773387339734073417342734373447345734673477348734973507351735273537354735573567357735873597360736173627363736473657366736773687369737073717372737373747375737673777378737973807381738273837384738573867387738873897390739173927393739473957396739773987399740074017402740374047405740674077408740974107411741274137414741574167417741874197420742174227423742474257426742774287429743074317432743374347435743674377438743974407441744274437444744574467447744874497450745174527453745474557456745774587459746074617462746374647465746674677468746974707471747274737474747574767477747874797480748174827483748474857486748774887489749074917492749374947495749674977498749975007501750275037504750575067507750875097510751175127513751475157516751775187519752075217522752375247525752675277528752975307531753275337534753575367537753875397540754175427543754475457546754775487549755075517552755375547555755675577558755975607561756275637564756575667567756875697570757175727573757475757576757775787579758075817582758375847585758675877588758975907591759275937594759575967597759875997600760176027603760476057606760776087609761076117612761376147615761676177618761976207621762276237624762576267627762876297630763176327633763476357636763776387639764076417642764376447645764676477648764976507651765276537654765576567657765876597660766176627663766476657666766776687669767076717672767376747675767676777678767976807681768276837684768576867687768876897690769176927693769476957696769776987699770077017702770377047705770677077708770977107711771277137714771577167717771877197720772177227723772477257726772777287729773077317732773377347735773677377738773977407741774277437744774577467747774877497750775177527753775477557756775777587759776077617762776377647765776677677768776977707771777277737774777577767777777877797780778177827783778477857786778777887789779077917792779377947795779677977798779978007801780278037804780578067807780878097810781178127813781478157816781778187819782078217822782378247825782678277828782978307831783278337834783578367837783878397840784178427843784478457846784778487849785078517852785378547855785678577858785978607861786278637864786578667867786878697870787178727873787478757876787778787879788078817882788378847885788678877888788978907891789278937894789578967897789878997900790179027903790479057906790779087909791079117912791379147915791679177918791979207921792279237924792579267927792879297930793179327933793479357936793779387939794079417942794379447945794679477948794979507951795279537954795579567957795879597960796179627963796479657966796779687969797079717972797379747975797679777978797979807981798279837984798579867987798879897990799179927993799479957996799779987999800080018002800380048005800680078008800980108011801280138014801580168017801880198020802180228023802480258026802780288029803080318032803380348035803680378038803980408041804280438044804580468047804880498050805180528053805480558056805780588059806080618062806380648065806680678068806980708071807280738074807580768077807880798080808180828083808480858086808780888089809080918092809380948095809680978098809981008101810281038104810581068107810881098110811181128113811481158116811781188119812081218122812381248125812681278128812981308131813281338134813581368137813881398140814181428143814481458146814781488149815081518152815381548155815681578158815981608161816281638164816581668167816881698170817181728173817481758176817781788179818081818182818381848185818681878188818981908191819281938194819581968197819881998200820182028203820482058206820782088209821082118212821382148215821682178218821982208221822282238224822582268227822882298230823182328233823482358236823782388239824082418242824382448245824682478248824982508251825282538254825582568257825882598260826182628263826482658266826782688269827082718272827382748275827682778278827982808281828282838284828582868287828882898290829182928293829482958296829782988299830083018302830383048305830683078308830983108311831283138314831583168317831883198320832183228323832483258326832783288329833083318332833383348335833683378338833983408341834283438344834583468347834883498350835183528353835483558356835783588359836083618362836383648365836683678368836983708371837283738374837583768377837883798380838183828383838483858386838783888389839083918392839383948395839683978398839984008401840284038404840584068407840884098410841184128413841484158416841784188419842084218422842384248425842684278428842984308431843284338434843584368437843884398440844184428443844484458446844784488449845084518452845384548455845684578458845984608461846284638464846584668467846884698470847184728473847484758476847784788479848084818482848384848485848684878488848984908491849284938494849584968497849884998500850185028503850485058506850785088509851085118512851385148515851685178518851985208521852285238524852585268527852885298530853185328533853485358536853785388539854085418542854385448545854685478548854985508551855285538554855585568557855885598560856185628563856485658566856785688569857085718572857385748575857685778578857985808581858285838584858585868587858885898590859185928593859485958596859785988599860086018602860386048605860686078608860986108611861286138614861586168617861886198620862186228623862486258626862786288629863086318632863386348635863686378638863986408641864286438644864586468647864886498650865186528653865486558656865786588659866086618662866386648665866686678668866986708671867286738674867586768677867886798680868186828683868486858686868786888689869086918692869386948695869686978698869987008701870287038704870587068707870887098710871187128713871487158716871787188719872087218722872387248725872687278728872987308731873287338734873587368737873887398740874187428743874487458746874787488749875087518752875387548755875687578758875987608761876287638764876587668767876887698770877187728773877487758776877787788779878087818782878387848785878687878788878987908791879287938794879587968797879887998800880188028803880488058806880788088809881088118812881388148815881688178818881988208821882288238824882588268827882888298830883188328833883488358836883788388839884088418842884388448845884688478848884988508851885288538854885588568857885888598860886188628863886488658866886788688869887088718872887388748875887688778878887988808881888288838884888588868887888888898890889188928893889488958896889788988899890089018902890389048905890689078908890989108911891289138914891589168917891889198920892189228923892489258926892789288929893089318932893389348935893689378938893989408941894289438944894589468947894889498950895189528953895489558956895789588959896089618962896389648965896689678968896989708971897289738974897589768977897889798980898189828983898489858986898789888989899089918992899389948995899689978998899990009001900290039004900590069007900890099010901190129013901490159016901790189019902090219022902390249025902690279028902990309031903290339034903590369037903890399040904190429043904490459046904790489049905090519052905390549055905690579058905990609061906290639064906590669067906890699070907190729073907490759076907790789079908090819082908390849085908690879088908990909091909290939094909590969097909890999100910191029103910491059106910791089109911091119112911391149115911691179118911991209121912291239124912591269127912891299130913191329133913491359136913791389139914091419142914391449145914691479148914991509151915291539154915591569157915891599160916191629163916491659166916791689169917091719172917391749175917691779178917991809181918291839184918591869187918891899190919191929193919491959196919791989199920092019202920392049205920692079208920992109211921292139214921592169217921892199220922192229223922492259226922792289229923092319232923392349235923692379238923992409241924292439244924592469247924892499250925192529253925492559256925792589259926092619262926392649265926692679268926992709271927292739274927592769277927892799280928192829283928492859286928792889289929092919292929392949295929692979298929993009301930293039304930593069307930893099310931193129313931493159316931793189319932093219322932393249325932693279328932993309331933293339334933593369337933893399340934193429343934493459346934793489349935093519352935393549355935693579358935993609361936293639364936593669367936893699370937193729373937493759376937793789379938093819382938393849385938693879388938993909391939293939394939593969397939893999400940194029403940494059406940794089409941094119412941394149415941694179418941994209421942294239424942594269427942894299430943194329433943494359436943794389439944094419442944394449445944694479448944994509451945294539454945594569457945894599460946194629463946494659466946794689469947094719472947394749475947694779478947994809481948294839484948594869487948894899490949194929493949494959496949794989499950095019502950395049505950695079508950995109511951295139514951595169517951895199520952195229523952495259526952795289529953095319532953395349535953695379538953995409541954295439544954595469547954895499550955195529553955495559556955795589559956095619562956395649565956695679568956995709571957295739574957595769577957895799580958195829583958495859586958795889589959095919592959395949595959695979598959996009601960296039604960596069607960896099610961196129613961496159616961796189619962096219622962396249625962696279628962996309631963296339634963596369637963896399640964196429643964496459646964796489649965096519652965396549655965696579658965996609661966296639664966596669667966896699670967196729673967496759676967796789679968096819682968396849685968696879688968996909691969296939694969596969697969896999700970197029703970497059706970797089709971097119712971397149715971697179718971997209721972297239724972597269727972897299730973197329733973497359736973797389739974097419742974397449745974697479748974997509751975297539754975597569757975897599760976197629763976497659766976797689769977097719772977397749775977697779778977997809781978297839784978597869787978897899790979197929793979497959796979797989799980098019802980398049805980698079808980998109811981298139814981598169817981898199820982198229823982498259826982798289829983098319832983398349835983698379838983998409841984298439844984598469847984898499850985198529853985498559856985798589859986098619862986398649865986698679868986998709871987298739874987598769877987898799880988198829883988498859886988798889889989098919892989398949895989698979898989999009901990299039904990599069907990899099910991199129913991499159916991799189919992099219922992399249925992699279928992999309931993299339934993599369937993899399940994199429943994499459946994799489949995099519952995399549955995699579958995999609961996299639964996599669967996899699970997199729973997499759976997799789979998099819982998399849985998699879988998999909991999299939994999599969997999899991000010001100021000310004100051000610007100081000910010100111001210013100141001510016100171001810019100201002110022100231002410025100261002710028100291003010031100321003310034100351003610037100381003910040100411004210043100441004510046100471004810049100501005110052100531005410055100561005710058100591006010061100621006310064100651006610067100681006910070100711007210073100741007510076100771007810079100801008110082100831008410085100861008710088100891009010091100921009310094100951009610097100981009910100101011010210103101041010510106101071010810109101101011110112101131011410115101161011710118101191012010121101221012310124101251012610127101281012910130101311013210133101341013510136101371013810139101401014110142101431014410145101461014710148101491015010151101521015310154101551015610157101581015910160101611016210163101641016510166101671016810169101701017110172101731017410175101761017710178101791018010181101821018310184101851018610187101881018910190101911019210193101941019510196101971019810199102001020110202102031020410205102061020710208102091021010211102121021310214102151021610217102181021910220102211022210223102241022510226102271022810229102301023110232102331023410235102361023710238102391024010241102421024310244102451024610247102481024910250102511025210253102541025510256102571025810259102601026110262102631026410265102661026710268102691027010271102721027310274102751027610277102781027910280102811028210283102841028510286102871028810289102901029110292102931029410295102961029710298102991030010301103021030310304103051030610307103081030910310103111031210313103141031510316103171031810319103201032110322103231032410325103261032710328103291033010331103321033310334103351033610337103381033910340103411034210343103441034510346103471034810349103501035110352103531035410355103561035710358103591036010361103621036310364103651036610367103681036910370103711037210373103741037510376103771037810379103801038110382103831038410385103861038710388103891039010391103921039310394103951039610397103981039910400104011040210403104041040510406104071040810409104101041110412104131041410415104161041710418104191042010421104221042310424104251042610427104281042910430104311043210433104341043510436104371043810439104401044110442104431044410445104461044710448104491045010451104521045310454104551045610457104581045910460104611046210463104641046510466104671046810469104701047110472104731047410475104761047710478104791048010481104821048310484104851048610487104881048910490104911049210493104941049510496104971049810499105001050110502105031050410505105061050710508105091051010511105121051310514105151051610517105181051910520105211052210523105241052510526105271052810529105301053110532105331053410535105361053710538105391054010541105421054310544105451054610547105481054910550105511055210553105541055510556105571055810559105601056110562105631056410565105661056710568105691057010571105721057310574105751057610577105781057910580105811058210583105841058510586105871058810589105901059110592105931059410595105961059710598105991060010601106021060310604106051060610607106081060910610106111061210613106141061510616106171061810619106201062110622106231062410625106261062710628106291063010631106321063310634106351063610637106381063910640106411064210643106441064510646106471064810649106501065110652106531065410655106561065710658106591066010661106621066310664106651066610667106681066910670106711067210673106741067510676106771067810679106801068110682106831068410685106861068710688106891069010691106921069310694106951069610697106981069910700107011070210703107041070510706107071070810709107101071110712107131071410715107161071710718107191072010721107221072310724107251072610727107281072910730107311073210733107341073510736107371073810739107401074110742107431074410745107461074710748107491075010751107521075310754107551075610757107581075910760107611076210763107641076510766107671076810769107701077110772107731077410775107761077710778107791078010781107821078310784107851078610787107881078910790107911079210793107941079510796107971079810799108001080110802108031080410805108061080710808108091081010811108121081310814108151081610817108181081910820108211082210823108241082510826108271082810829108301083110832108331083410835108361083710838108391084010841108421084310844108451084610847108481084910850108511085210853108541085510856108571085810859108601086110862108631086410865108661086710868108691087010871108721087310874108751087610877108781087910880108811088210883108841088510886108871088810889108901089110892108931089410895108961089710898108991090010901109021090310904109051090610907109081090910910109111091210913109141091510916109171091810919109201092110922109231092410925109261092710928109291093010931109321093310934109351093610937109381093910940109411094210943109441094510946109471094810949109501095110952109531095410955109561095710958109591096010961109621096310964109651096610967109681096910970109711097210973109741097510976109771097810979109801098110982109831098410985109861098710988109891099010991109921099310994109951099610997109981099911000110011100211003110041100511006110071100811009110101101111012110131101411015110161101711018110191102011021110221102311024110251102611027110281102911030110311103211033110341103511036110371103811039110401104111042110431104411045110461104711048110491105011051110521105311054110551105611057110581105911060110611106211063110641106511066110671106811069110701107111072110731107411075110761107711078110791108011081110821108311084110851108611087110881108911090110911109211093110941109511096110971109811099111001110111102111031110411105111061110711108111091111011111111121111311114111151111611117111181111911120111211112211123111241112511126111271112811129111301113111132111331113411135111361113711138111391114011141111421114311144111451114611147111481114911150111511115211153111541115511156111571115811159111601116111162111631116411165111661116711168111691117011171111721117311174111751117611177111781117911180111811118211183111841118511186111871118811189111901119111192111931119411195111961119711198111991120011201112021120311204112051120611207112081120911210112111121211213112141121511216112171121811219112201122111222112231122411225112261122711228112291123011231112321123311234112351123611237112381123911240112411124211243112441124511246112471124811249112501125111252112531125411255112561125711258112591126011261112621126311264112651126611267112681126911270112711127211273112741127511276112771127811279112801128111282112831128411285112861128711288112891129011291112921129311294112951129611297112981129911300113011130211303113041130511306113071130811309113101131111312113131131411315113161131711318113191132011321113221132311324113251132611327113281132911330113311133211333113341133511336113371133811339113401134111342113431134411345113461134711348113491135011351113521135311354113551135611357113581135911360113611136211363113641136511366113671136811369113701137111372113731137411375113761137711378113791138011381113821138311384113851138611387113881138911390113911139211393113941139511396113971139811399114001140111402114031140411405114061140711408114091141011411114121141311414114151141611417114181141911420114211142211423114241142511426114271142811429114301143111432114331143411435114361143711438114391144011441114421144311444114451144611447114481144911450114511145211453114541145511456114571145811459114601146111462114631146411465114661146711468114691147011471114721147311474114751147611477114781147911480114811148211483114841148511486114871148811489114901149111492114931149411495114961149711498114991150011501115021150311504115051150611507115081150911510115111151211513115141151511516115171151811519115201152111522115231152411525115261152711528115291153011531115321153311534115351153611537115381153911540115411154211543115441154511546115471154811549115501155111552115531155411555115561155711558115591156011561115621156311564115651156611567115681156911570115711157211573115741157511576115771157811579115801158111582115831158411585115861158711588115891159011591115921159311594115951159611597115981159911600116011160211603116041160511606116071160811609116101161111612116131161411615116161161711618116191162011621116221162311624116251162611627116281162911630116311163211633116341163511636116371163811639116401164111642116431164411645116461164711648116491165011651116521165311654116551165611657116581165911660116611166211663116641166511666116671166811669116701167111672116731167411675116761167711678116791168011681116821168311684116851168611687116881168911690116911169211693116941169511696116971169811699117001170111702117031170411705117061170711708117091171011711117121171311714117151171611717117181171911720117211172211723117241172511726117271172811729117301173111732117331173411735117361173711738117391174011741117421174311744117451174611747117481174911750117511175211753117541175511756117571175811759117601176111762117631176411765117661176711768117691177011771117721177311774117751177611777117781177911780117811178211783117841178511786117871178811789117901179111792117931179411795117961179711798117991180011801118021180311804118051180611807118081180911810118111181211813118141181511816118171181811819118201182111822118231182411825118261182711828118291183011831118321183311834118351183611837118381183911840118411184211843118441184511846118471184811849118501185111852118531185411855118561185711858118591186011861118621186311864118651186611867118681186911870118711187211873118741187511876118771187811879118801188111882118831188411885118861188711888118891189011891118921189311894118951189611897118981189911900119011190211903119041190511906119071190811909119101191111912119131191411915119161191711918119191192011921119221192311924119251192611927119281192911930119311193211933119341193511936119371193811939119401194111942119431194411945119461194711948119491195011951119521195311954119551195611957119581195911960119611196211963119641196511966119671196811969119701197111972119731197411975119761197711978119791198011981119821198311984119851198611987119881198911990119911199211993119941199511996119971199811999120001200112002120031200412005120061200712008120091201012011120121201312014120151201612017120181201912020120211202212023120241202512026120271202812029120301203112032120331203412035120361203712038120391204012041120421204312044120451204612047120481204912050120511205212053120541205512056120571205812059120601206112062120631206412065120661206712068120691207012071120721207312074120751207612077120781207912080120811208212083120841208512086120871208812089120901209112092120931209412095120961209712098120991210012101121021210312104121051210612107121081210912110121111211212113121141211512116121171211812119121201212112122121231212412125121261212712128121291213012131121321213312134121351213612137121381213912140121411214212143121441214512146121471214812149121501215112152121531215412155121561215712158121591216012161121621216312164121651216612167121681216912170121711217212173121741217512176121771217812179121801218112182121831218412185121861218712188121891219012191121921219312194121951219612197121981219912200122011220212203122041220512206122071220812209122101221112212122131221412215122161221712218122191222012221122221222312224122251222612227122281222912230122311223212233122341223512236122371223812239122401224112242122431224412245122461224712248122491225012251122521225312254122551225612257122581225912260122611226212263122641226512266122671226812269122701227112272122731227412275122761227712278122791228012281122821228312284122851228612287122881228912290122911229212293122941229512296122971229812299123001230112302123031230412305123061230712308123091231012311123121231312314123151231612317123181231912320123211232212323123241232512326123271232812329123301233112332123331233412335123361233712338123391234012341123421234312344123451234612347123481234912350123511235212353123541235512356123571235812359123601236112362123631236412365123661236712368123691237012371123721237312374123751237612377123781237912380123811238212383123841238512386123871238812389123901239112392123931239412395123961239712398123991240012401124021240312404124051240612407124081240912410124111241212413124141241512416124171241812419124201242112422124231242412425124261242712428124291243012431124321243312434124351243612437124381243912440124411244212443124441244512446124471244812449124501245112452124531245412455124561245712458124591246012461124621246312464124651246612467124681246912470124711247212473124741247512476124771247812479124801248112482124831248412485124861248712488124891249012491124921249312494124951249612497124981249912500125011250212503125041250512506125071250812509125101251112512125131251412515125161251712518125191252012521125221252312524125251252612527125281252912530125311253212533125341253512536125371253812539125401254112542125431254412545125461254712548125491255012551125521255312554125551255612557125581255912560125611256212563125641256512566125671256812569125701257112572125731257412575125761257712578125791258012581125821258312584125851258612587125881258912590125911259212593125941259512596125971259812599126001260112602126031260412605126061260712608126091261012611126121261312614126151261612617126181261912620126211262212623126241262512626126271262812629126301263112632126331263412635126361263712638126391264012641126421264312644126451264612647126481264912650126511265212653126541265512656126571265812659126601266112662126631266412665126661266712668126691267012671126721267312674126751267612677126781267912680126811268212683126841268512686126871268812689126901269112692126931269412695126961269712698126991270012701127021270312704127051270612707127081270912710127111271212713127141271512716127171271812719127201272112722127231272412725127261272712728127291273012731127321273312734127351273612737127381273912740127411274212743127441274512746127471274812749127501275112752127531275412755127561275712758127591276012761127621276312764127651276612767127681276912770127711277212773127741277512776127771277812779127801278112782127831278412785127861278712788127891279012791127921279312794127951279612797127981279912800128011280212803128041280512806128071280812809128101281112812128131281412815128161281712818128191282012821128221282312824128251282612827128281282912830128311283212833128341283512836128371283812839128401284112842128431284412845128461284712848128491285012851128521285312854128551285612857128581285912860128611286212863128641286512866128671286812869128701287112872128731287412875128761287712878128791288012881128821288312884128851288612887128881288912890128911289212893128941289512896128971289812899129001290112902129031290412905129061290712908129091291012911129121291312914129151291612917129181291912920129211292212923129241292512926129271292812929129301293112932129331293412935129361293712938129391294012941129421294312944129451294612947129481294912950129511295212953129541295512956129571295812959129601296112962129631296412965129661296712968129691297012971129721297312974129751297612977129781297912980129811298212983129841298512986129871298812989129901299112992129931299412995129961299712998129991300013001130021300313004130051300613007130081300913010130111301213013130141301513016130171301813019130201302113022130231302413025130261302713028130291303013031130321303313034130351303613037130381303913040130411304213043130441304513046130471304813049130501305113052130531305413055130561305713058130591306013061130621306313064130651306613067130681306913070130711307213073130741307513076130771307813079130801308113082130831308413085130861308713088130891309013091130921309313094130951309613097130981309913100131011310213103131041310513106131071310813109131101311113112131131311413115131161311713118131191312013121131221312313124131251312613127131281312913130131311313213133131341313513136131371313813139131401314113142131431314413145131461314713148131491315013151131521315313154131551315613157131581315913160131611316213163131641316513166131671316813169131701317113172131731317413175131761317713178131791318013181131821318313184131851318613187131881318913190131911319213193131941319513196131971319813199132001320113202132031320413205132061320713208132091321013211132121321313214132151321613217132181321913220132211322213223132241322513226132271322813229132301323113232132331323413235132361323713238132391324013241132421324313244132451324613247132481324913250132511325213253132541325513256132571325813259132601326113262132631326413265132661326713268132691327013271132721327313274132751327613277132781327913280132811328213283132841328513286132871328813289132901329113292132931329413295132961329713298132991330013301133021330313304133051330613307133081330913310133111331213313133141331513316133171331813319133201332113322133231332413325133261332713328133291333013331133321333313334133351333613337133381333913340133411334213343133441334513346133471334813349133501335113352133531335413355133561335713358133591336013361133621336313364133651336613367133681336913370133711337213373133741337513376133771337813379133801338113382133831338413385133861338713388133891339013391133921339313394133951339613397133981339913400134011340213403134041340513406134071340813409134101341113412134131341413415134161341713418134191342013421134221342313424134251342613427134281342913430134311343213433134341343513436134371343813439134401344113442134431344413445134461344713448134491345013451134521345313454134551345613457134581345913460134611346213463134641346513466134671346813469134701347113472134731347413475134761347713478134791348013481134821348313484134851348613487134881348913490134911349213493134941349513496134971349813499135001350113502135031350413505135061350713508135091351013511135121351313514135151351613517135181351913520135211352213523135241352513526135271352813529135301353113532135331353413535135361353713538135391354013541135421354313544135451354613547135481354913550135511355213553135541355513556135571355813559135601356113562135631356413565135661356713568135691357013571135721357313574135751357613577135781357913580135811358213583135841358513586135871358813589135901359113592135931359413595135961359713598135991360013601136021360313604136051360613607136081360913610136111361213613136141361513616136171361813619136201362113622136231362413625136261362713628136291363013631136321363313634136351363613637136381363913640136411364213643136441364513646136471364813649136501365113652136531365413655136561365713658136591366013661136621366313664136651366613667136681366913670136711367213673136741367513676136771367813679136801368113682136831368413685136861368713688136891369013691136921369313694136951369613697136981369913700137011370213703137041370513706137071370813709137101371113712137131371413715137161371713718137191372013721137221372313724137251372613727137281372913730137311373213733137341373513736137371373813739137401374113742137431374413745137461374713748137491375013751137521375313754137551375613757137581375913760137611376213763137641376513766137671376813769137701377113772137731377413775137761377713778137791378013781137821378313784137851378613787137881378913790137911379213793137941379513796137971379813799138001380113802138031380413805138061380713808138091381013811138121381313814138151381613817138181381913820138211382213823138241382513826138271382813829138301383113832138331383413835138361383713838138391384013841138421384313844138451384613847138481384913850138511385213853138541385513856138571385813859138601386113862138631386413865138661386713868138691387013871138721387313874138751387613877138781387913880138811388213883138841388513886138871388813889138901389113892138931389413895138961389713898138991390013901139021390313904139051390613907139081390913910139111391213913139141391513916139171391813919139201392113922139231392413925139261392713928139291393013931139321393313934139351393613937139381393913940139411394213943139441394513946139471394813949139501395113952139531395413955139561395713958139591396013961139621396313964139651396613967139681396913970139711397213973139741397513976139771397813979139801398113982139831398413985139861398713988139891399013991139921399313994139951399613997139981399914000140011400214003140041400514006140071400814009140101401114012140131401414015140161401714018140191402014021140221402314024140251402614027140281402914030140311403214033140341403514036140371403814039140401404114042140431404414045140461404714048140491405014051140521405314054140551405614057140581405914060140611406214063140641406514066140671406814069140701407114072140731407414075140761407714078140791408014081140821408314084140851408614087140881408914090140911409214093140941409514096140971409814099141001410114102141031410414105141061410714108141091411014111141121411314114141151411614117141181411914120141211412214123141241412514126141271412814129141301413114132141331413414135141361413714138141391414014141141421414314144141451414614147141481414914150141511415214153141541415514156141571415814159141601416114162141631416414165141661416714168141691417014171141721417314174141751417614177141781417914180141811418214183141841418514186141871418814189141901419114192141931419414195141961419714198141991420014201142021420314204142051420614207142081420914210142111421214213142141421514216142171421814219142201422114222142231422414225142261422714228142291423014231142321423314234142351423614237142381423914240142411424214243142441424514246142471424814249142501425114252142531425414255142561425714258142591426014261142621426314264142651426614267142681426914270142711427214273142741427514276142771427814279142801428114282142831428414285142861428714288142891429014291142921429314294142951429614297142981429914300143011430214303143041430514306143071430814309143101431114312143131431414315143161431714318143191432014321143221432314324143251432614327143281432914330143311433214333143341433514336143371433814339143401434114342143431434414345143461434714348143491435014351143521435314354143551435614357143581435914360143611436214363143641436514366143671436814369143701437114372143731437414375143761437714378143791438014381143821438314384143851438614387143881438914390143911439214393143941439514396143971439814399144001440114402144031440414405144061440714408144091441014411144121441314414144151441614417144181441914420144211442214423144241442514426144271442814429144301443114432144331443414435144361443714438144391444014441144421444314444144451444614447144481444914450144511445214453144541445514456144571445814459144601446114462144631446414465144661446714468144691447014471144721447314474144751447614477144781447914480144811448214483144841448514486144871448814489144901449114492144931449414495144961449714498144991450014501145021450314504145051450614507145081450914510145111451214513145141451514516145171451814519145201452114522145231452414525145261452714528145291453014531145321453314534145351453614537145381453914540145411454214543145441454514546145471454814549145501455114552145531455414555145561455714558145591456014561145621456314564145651456614567145681456914570145711457214573145741457514576145771457814579145801458114582145831458414585145861458714588145891459014591145921459314594145951459614597145981459914600146011460214603146041460514606146071460814609146101461114612146131461414615146161461714618146191462014621146221462314624146251462614627146281462914630146311463214633146341463514636146371463814639146401464114642146431464414645146461464714648146491465014651146521465314654146551465614657146581465914660146611466214663146641466514666146671466814669146701467114672146731467414675146761467714678146791468014681146821468314684146851468614687146881468914690146911469214693146941469514696146971469814699147001470114702147031470414705147061470714708147091471014711147121471314714147151471614717147181471914720147211472214723147241472514726147271472814729147301473114732147331473414735147361473714738147391474014741147421474314744147451474614747147481474914750147511475214753147541475514756 |
- /** @file
- * @brief MAVLink comm protocol testsuite generated from common.xml
- * @see https://mavlink.io/en/
- */
- #pragma once
- #ifndef COMMON_TESTSUITE_H
- #define COMMON_TESTSUITE_H
- #ifdef __cplusplus
- extern "C" {
- #endif
- #ifndef MAVLINK_TEST_ALL
- #define MAVLINK_TEST_ALL
- static void mavlink_test_standard(uint8_t, uint8_t, mavlink_message_t *last_msg);
- static void mavlink_test_common(uint8_t, uint8_t, mavlink_message_t *last_msg);
- static void mavlink_test_all(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- mavlink_test_standard(system_id, component_id, last_msg);
- mavlink_test_common(system_id, component_id, last_msg);
- }
- #endif
- #include "../standard/testsuite.h"
- static void mavlink_test_sys_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SYS_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_sys_status_t packet_in = {
- 963497464,963497672,963497880,17859,17963,18067,18171,18275,18379,18483,18587,18691,223,963499076,963499284,963499492
- };
- mavlink_sys_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.onboard_control_sensors_present = packet_in.onboard_control_sensors_present;
- packet1.onboard_control_sensors_enabled = packet_in.onboard_control_sensors_enabled;
- packet1.onboard_control_sensors_health = packet_in.onboard_control_sensors_health;
- packet1.load = packet_in.load;
- packet1.voltage_battery = packet_in.voltage_battery;
- packet1.current_battery = packet_in.current_battery;
- packet1.drop_rate_comm = packet_in.drop_rate_comm;
- packet1.errors_comm = packet_in.errors_comm;
- packet1.errors_count1 = packet_in.errors_count1;
- packet1.errors_count2 = packet_in.errors_count2;
- packet1.errors_count3 = packet_in.errors_count3;
- packet1.errors_count4 = packet_in.errors_count4;
- packet1.battery_remaining = packet_in.battery_remaining;
- packet1.onboard_control_sensors_present_extended = packet_in.onboard_control_sensors_present_extended;
- packet1.onboard_control_sensors_enabled_extended = packet_in.onboard_control_sensors_enabled_extended;
- packet1.onboard_control_sensors_health_extended = packet_in.onboard_control_sensors_health_extended;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SYS_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SYS_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_sys_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_sys_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_sys_status_pack(system_id, component_id, &msg , packet1.onboard_control_sensors_present , packet1.onboard_control_sensors_enabled , packet1.onboard_control_sensors_health , packet1.load , packet1.voltage_battery , packet1.current_battery , packet1.battery_remaining , packet1.drop_rate_comm , packet1.errors_comm , packet1.errors_count1 , packet1.errors_count2 , packet1.errors_count3 , packet1.errors_count4 , packet1.onboard_control_sensors_present_extended , packet1.onboard_control_sensors_enabled_extended , packet1.onboard_control_sensors_health_extended );
- mavlink_msg_sys_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_sys_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.onboard_control_sensors_present , packet1.onboard_control_sensors_enabled , packet1.onboard_control_sensors_health , packet1.load , packet1.voltage_battery , packet1.current_battery , packet1.battery_remaining , packet1.drop_rate_comm , packet1.errors_comm , packet1.errors_count1 , packet1.errors_count2 , packet1.errors_count3 , packet1.errors_count4 , packet1.onboard_control_sensors_present_extended , packet1.onboard_control_sensors_enabled_extended , packet1.onboard_control_sensors_health_extended );
- mavlink_msg_sys_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_sys_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_sys_status_send(MAVLINK_COMM_1 , packet1.onboard_control_sensors_present , packet1.onboard_control_sensors_enabled , packet1.onboard_control_sensors_health , packet1.load , packet1.voltage_battery , packet1.current_battery , packet1.battery_remaining , packet1.drop_rate_comm , packet1.errors_comm , packet1.errors_count1 , packet1.errors_count2 , packet1.errors_count3 , packet1.errors_count4 , packet1.onboard_control_sensors_present_extended , packet1.onboard_control_sensors_enabled_extended , packet1.onboard_control_sensors_health_extended );
- mavlink_msg_sys_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SYS_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SYS_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_system_time(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SYSTEM_TIME >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_system_time_t packet_in = {
- 93372036854775807ULL,963497880
- };
- mavlink_system_time_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_unix_usec = packet_in.time_unix_usec;
- packet1.time_boot_ms = packet_in.time_boot_ms;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SYSTEM_TIME_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SYSTEM_TIME_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_system_time_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_system_time_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_system_time_pack(system_id, component_id, &msg , packet1.time_unix_usec , packet1.time_boot_ms );
- mavlink_msg_system_time_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_system_time_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_unix_usec , packet1.time_boot_ms );
- mavlink_msg_system_time_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_system_time_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_system_time_send(MAVLINK_COMM_1 , packet1.time_unix_usec , packet1.time_boot_ms );
- mavlink_msg_system_time_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SYSTEM_TIME") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SYSTEM_TIME) != NULL);
- #endif
- }
- static void mavlink_test_ping(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_PING >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_ping_t packet_in = {
- 93372036854775807ULL,963497880,41,108
- };
- mavlink_ping_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.seq = packet_in.seq;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_PING_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_PING_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_ping_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_ping_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_ping_pack(system_id, component_id, &msg , packet1.time_usec , packet1.seq , packet1.target_system , packet1.target_component );
- mavlink_msg_ping_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_ping_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.seq , packet1.target_system , packet1.target_component );
- mavlink_msg_ping_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_ping_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_ping_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.seq , packet1.target_system , packet1.target_component );
- mavlink_msg_ping_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("PING") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_PING) != NULL);
- #endif
- }
- static void mavlink_test_change_operator_control(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CHANGE_OPERATOR_CONTROL >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_change_operator_control_t packet_in = {
- 5,72,139,"DEFGHIJKLMNOPQRSTUVWXYZA"
- };
- mavlink_change_operator_control_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_system = packet_in.target_system;
- packet1.control_request = packet_in.control_request;
- packet1.version = packet_in.version;
-
- mav_array_memcpy(packet1.passkey, packet_in.passkey, sizeof(char)*25);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CHANGE_OPERATOR_CONTROL_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CHANGE_OPERATOR_CONTROL_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_change_operator_control_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_change_operator_control_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_change_operator_control_pack(system_id, component_id, &msg , packet1.target_system , packet1.control_request , packet1.version , packet1.passkey );
- mavlink_msg_change_operator_control_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_change_operator_control_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.control_request , packet1.version , packet1.passkey );
- mavlink_msg_change_operator_control_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_change_operator_control_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_change_operator_control_send(MAVLINK_COMM_1 , packet1.target_system , packet1.control_request , packet1.version , packet1.passkey );
- mavlink_msg_change_operator_control_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CHANGE_OPERATOR_CONTROL") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CHANGE_OPERATOR_CONTROL) != NULL);
- #endif
- }
- static void mavlink_test_change_operator_control_ack(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CHANGE_OPERATOR_CONTROL_ACK >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_change_operator_control_ack_t packet_in = {
- 5,72,139
- };
- mavlink_change_operator_control_ack_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.gcs_system_id = packet_in.gcs_system_id;
- packet1.control_request = packet_in.control_request;
- packet1.ack = packet_in.ack;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CHANGE_OPERATOR_CONTROL_ACK_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CHANGE_OPERATOR_CONTROL_ACK_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_change_operator_control_ack_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_change_operator_control_ack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_change_operator_control_ack_pack(system_id, component_id, &msg , packet1.gcs_system_id , packet1.control_request , packet1.ack );
- mavlink_msg_change_operator_control_ack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_change_operator_control_ack_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.gcs_system_id , packet1.control_request , packet1.ack );
- mavlink_msg_change_operator_control_ack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_change_operator_control_ack_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_change_operator_control_ack_send(MAVLINK_COMM_1 , packet1.gcs_system_id , packet1.control_request , packet1.ack );
- mavlink_msg_change_operator_control_ack_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CHANGE_OPERATOR_CONTROL_ACK") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CHANGE_OPERATOR_CONTROL_ACK) != NULL);
- #endif
- }
- static void mavlink_test_auth_key(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_AUTH_KEY >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_auth_key_t packet_in = {
- "ABCDEFGHIJKLMNOPQRSTUVWXYZABCDE"
- };
- mavlink_auth_key_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
-
- mav_array_memcpy(packet1.key, packet_in.key, sizeof(char)*32);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_AUTH_KEY_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_AUTH_KEY_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_auth_key_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_auth_key_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_auth_key_pack(system_id, component_id, &msg , packet1.key );
- mavlink_msg_auth_key_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_auth_key_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.key );
- mavlink_msg_auth_key_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_auth_key_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_auth_key_send(MAVLINK_COMM_1 , packet1.key );
- mavlink_msg_auth_key_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("AUTH_KEY") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_AUTH_KEY) != NULL);
- #endif
- }
- static void mavlink_test_link_node_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_LINK_NODE_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_link_node_status_t packet_in = {
- 93372036854775807ULL,963497880,963498088,963498296,963498504,963498712,18691,18795,18899,235,46
- };
- mavlink_link_node_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.timestamp = packet_in.timestamp;
- packet1.tx_rate = packet_in.tx_rate;
- packet1.rx_rate = packet_in.rx_rate;
- packet1.messages_sent = packet_in.messages_sent;
- packet1.messages_received = packet_in.messages_received;
- packet1.messages_lost = packet_in.messages_lost;
- packet1.rx_parse_err = packet_in.rx_parse_err;
- packet1.tx_overflows = packet_in.tx_overflows;
- packet1.rx_overflows = packet_in.rx_overflows;
- packet1.tx_buf = packet_in.tx_buf;
- packet1.rx_buf = packet_in.rx_buf;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_LINK_NODE_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_LINK_NODE_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_link_node_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_link_node_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_link_node_status_pack(system_id, component_id, &msg , packet1.timestamp , packet1.tx_buf , packet1.rx_buf , packet1.tx_rate , packet1.rx_rate , packet1.rx_parse_err , packet1.tx_overflows , packet1.rx_overflows , packet1.messages_sent , packet1.messages_received , packet1.messages_lost );
- mavlink_msg_link_node_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_link_node_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.timestamp , packet1.tx_buf , packet1.rx_buf , packet1.tx_rate , packet1.rx_rate , packet1.rx_parse_err , packet1.tx_overflows , packet1.rx_overflows , packet1.messages_sent , packet1.messages_received , packet1.messages_lost );
- mavlink_msg_link_node_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_link_node_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_link_node_status_send(MAVLINK_COMM_1 , packet1.timestamp , packet1.tx_buf , packet1.rx_buf , packet1.tx_rate , packet1.rx_rate , packet1.rx_parse_err , packet1.tx_overflows , packet1.rx_overflows , packet1.messages_sent , packet1.messages_received , packet1.messages_lost );
- mavlink_msg_link_node_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("LINK_NODE_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_LINK_NODE_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_set_mode(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SET_MODE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_set_mode_t packet_in = {
- 963497464,17,84
- };
- mavlink_set_mode_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.custom_mode = packet_in.custom_mode;
- packet1.target_system = packet_in.target_system;
- packet1.base_mode = packet_in.base_mode;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SET_MODE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SET_MODE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_mode_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_set_mode_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_mode_pack(system_id, component_id, &msg , packet1.target_system , packet1.base_mode , packet1.custom_mode );
- mavlink_msg_set_mode_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_mode_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.base_mode , packet1.custom_mode );
- mavlink_msg_set_mode_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_set_mode_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_mode_send(MAVLINK_COMM_1 , packet1.target_system , packet1.base_mode , packet1.custom_mode );
- mavlink_msg_set_mode_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SET_MODE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SET_MODE) != NULL);
- #endif
- }
- static void mavlink_test_param_request_read(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_PARAM_REQUEST_READ >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_param_request_read_t packet_in = {
- 17235,139,206,"EFGHIJKLMNOPQRS"
- };
- mavlink_param_request_read_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.param_index = packet_in.param_index;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
- mav_array_memcpy(packet1.param_id, packet_in.param_id, sizeof(char)*16);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_PARAM_REQUEST_READ_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_PARAM_REQUEST_READ_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_request_read_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_param_request_read_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_request_read_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.param_id , packet1.param_index );
- mavlink_msg_param_request_read_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_request_read_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.param_id , packet1.param_index );
- mavlink_msg_param_request_read_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_param_request_read_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_request_read_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.param_id , packet1.param_index );
- mavlink_msg_param_request_read_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("PARAM_REQUEST_READ") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_PARAM_REQUEST_READ) != NULL);
- #endif
- }
- static void mavlink_test_param_request_list(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_PARAM_REQUEST_LIST >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_param_request_list_t packet_in = {
- 5,72
- };
- mavlink_param_request_list_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_PARAM_REQUEST_LIST_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_PARAM_REQUEST_LIST_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_request_list_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_param_request_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_request_list_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component );
- mavlink_msg_param_request_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_request_list_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component );
- mavlink_msg_param_request_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_param_request_list_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_request_list_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component );
- mavlink_msg_param_request_list_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("PARAM_REQUEST_LIST") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_PARAM_REQUEST_LIST) != NULL);
- #endif
- }
- static void mavlink_test_param_value(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_PARAM_VALUE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_param_value_t packet_in = {
- 17.0,17443,17547,"IJKLMNOPQRSTUVW",77
- };
- mavlink_param_value_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.param_value = packet_in.param_value;
- packet1.param_count = packet_in.param_count;
- packet1.param_index = packet_in.param_index;
- packet1.param_type = packet_in.param_type;
-
- mav_array_memcpy(packet1.param_id, packet_in.param_id, sizeof(char)*16);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_PARAM_VALUE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_PARAM_VALUE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_value_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_param_value_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_value_pack(system_id, component_id, &msg , packet1.param_id , packet1.param_value , packet1.param_type , packet1.param_count , packet1.param_index );
- mavlink_msg_param_value_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_value_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.param_id , packet1.param_value , packet1.param_type , packet1.param_count , packet1.param_index );
- mavlink_msg_param_value_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_param_value_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_value_send(MAVLINK_COMM_1 , packet1.param_id , packet1.param_value , packet1.param_type , packet1.param_count , packet1.param_index );
- mavlink_msg_param_value_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("PARAM_VALUE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_PARAM_VALUE) != NULL);
- #endif
- }
- static void mavlink_test_param_set(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_PARAM_SET >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_param_set_t packet_in = {
- 17.0,17,84,"GHIJKLMNOPQRSTU",199
- };
- mavlink_param_set_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.param_value = packet_in.param_value;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.param_type = packet_in.param_type;
-
- mav_array_memcpy(packet1.param_id, packet_in.param_id, sizeof(char)*16);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_PARAM_SET_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_PARAM_SET_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_set_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_param_set_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_set_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.param_id , packet1.param_value , packet1.param_type );
- mavlink_msg_param_set_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_set_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.param_id , packet1.param_value , packet1.param_type );
- mavlink_msg_param_set_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_param_set_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_set_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.param_id , packet1.param_value , packet1.param_type );
- mavlink_msg_param_set_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("PARAM_SET") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_PARAM_SET) != NULL);
- #endif
- }
- static void mavlink_test_gps_raw_int(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GPS_RAW_INT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gps_raw_int_t packet_in = {
- 93372036854775807ULL,963497880,963498088,963498296,18275,18379,18483,18587,89,156,963499024,963499232,963499440,963499648,963499856,19835
- };
- mavlink_gps_raw_int_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.alt = packet_in.alt;
- packet1.eph = packet_in.eph;
- packet1.epv = packet_in.epv;
- packet1.vel = packet_in.vel;
- packet1.cog = packet_in.cog;
- packet1.fix_type = packet_in.fix_type;
- packet1.satellites_visible = packet_in.satellites_visible;
- packet1.alt_ellipsoid = packet_in.alt_ellipsoid;
- packet1.h_acc = packet_in.h_acc;
- packet1.v_acc = packet_in.v_acc;
- packet1.vel_acc = packet_in.vel_acc;
- packet1.hdg_acc = packet_in.hdg_acc;
- packet1.yaw = packet_in.yaw;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GPS_RAW_INT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GPS_RAW_INT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_raw_int_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gps_raw_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_raw_int_pack(system_id, component_id, &msg , packet1.time_usec , packet1.fix_type , packet1.lat , packet1.lon , packet1.alt , packet1.eph , packet1.epv , packet1.vel , packet1.cog , packet1.satellites_visible , packet1.alt_ellipsoid , packet1.h_acc , packet1.v_acc , packet1.vel_acc , packet1.hdg_acc , packet1.yaw );
- mavlink_msg_gps_raw_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_raw_int_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.fix_type , packet1.lat , packet1.lon , packet1.alt , packet1.eph , packet1.epv , packet1.vel , packet1.cog , packet1.satellites_visible , packet1.alt_ellipsoid , packet1.h_acc , packet1.v_acc , packet1.vel_acc , packet1.hdg_acc , packet1.yaw );
- mavlink_msg_gps_raw_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gps_raw_int_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_raw_int_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.fix_type , packet1.lat , packet1.lon , packet1.alt , packet1.eph , packet1.epv , packet1.vel , packet1.cog , packet1.satellites_visible , packet1.alt_ellipsoid , packet1.h_acc , packet1.v_acc , packet1.vel_acc , packet1.hdg_acc , packet1.yaw );
- mavlink_msg_gps_raw_int_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GPS_RAW_INT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GPS_RAW_INT) != NULL);
- #endif
- }
- static void mavlink_test_gps_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GPS_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gps_status_t packet_in = {
- 5,{ 72, 73, 74, 75, 76, 77, 78, 79, 80, 81, 82, 83, 84, 85, 86, 87, 88, 89, 90, 91 },{ 132, 133, 134, 135, 136, 137, 138, 139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151 },{ 192, 193, 194, 195, 196, 197, 198, 199, 200, 201, 202, 203, 204, 205, 206, 207, 208, 209, 210, 211 },{ 252, 253, 254, 255, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15 },{ 56, 57, 58, 59, 60, 61, 62, 63, 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75 }
- };
- mavlink_gps_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.satellites_visible = packet_in.satellites_visible;
-
- mav_array_memcpy(packet1.satellite_prn, packet_in.satellite_prn, sizeof(uint8_t)*20);
- mav_array_memcpy(packet1.satellite_used, packet_in.satellite_used, sizeof(uint8_t)*20);
- mav_array_memcpy(packet1.satellite_elevation, packet_in.satellite_elevation, sizeof(uint8_t)*20);
- mav_array_memcpy(packet1.satellite_azimuth, packet_in.satellite_azimuth, sizeof(uint8_t)*20);
- mav_array_memcpy(packet1.satellite_snr, packet_in.satellite_snr, sizeof(uint8_t)*20);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GPS_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GPS_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gps_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_status_pack(system_id, component_id, &msg , packet1.satellites_visible , packet1.satellite_prn , packet1.satellite_used , packet1.satellite_elevation , packet1.satellite_azimuth , packet1.satellite_snr );
- mavlink_msg_gps_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.satellites_visible , packet1.satellite_prn , packet1.satellite_used , packet1.satellite_elevation , packet1.satellite_azimuth , packet1.satellite_snr );
- mavlink_msg_gps_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gps_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_status_send(MAVLINK_COMM_1 , packet1.satellites_visible , packet1.satellite_prn , packet1.satellite_used , packet1.satellite_elevation , packet1.satellite_azimuth , packet1.satellite_snr );
- mavlink_msg_gps_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GPS_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GPS_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_scaled_imu(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SCALED_IMU >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_scaled_imu_t packet_in = {
- 963497464,17443,17547,17651,17755,17859,17963,18067,18171,18275,18379
- };
- mavlink_scaled_imu_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.xacc = packet_in.xacc;
- packet1.yacc = packet_in.yacc;
- packet1.zacc = packet_in.zacc;
- packet1.xgyro = packet_in.xgyro;
- packet1.ygyro = packet_in.ygyro;
- packet1.zgyro = packet_in.zgyro;
- packet1.xmag = packet_in.xmag;
- packet1.ymag = packet_in.ymag;
- packet1.zmag = packet_in.zmag;
- packet1.temperature = packet_in.temperature;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SCALED_IMU_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SCALED_IMU_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_imu_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_scaled_imu_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_imu_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.temperature );
- mavlink_msg_scaled_imu_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_imu_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.temperature );
- mavlink_msg_scaled_imu_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_scaled_imu_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_imu_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.temperature );
- mavlink_msg_scaled_imu_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SCALED_IMU") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SCALED_IMU) != NULL);
- #endif
- }
- static void mavlink_test_raw_imu(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_RAW_IMU >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_raw_imu_t packet_in = {
- 93372036854775807ULL,17651,17755,17859,17963,18067,18171,18275,18379,18483,211,18639
- };
- mavlink_raw_imu_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.xacc = packet_in.xacc;
- packet1.yacc = packet_in.yacc;
- packet1.zacc = packet_in.zacc;
- packet1.xgyro = packet_in.xgyro;
- packet1.ygyro = packet_in.ygyro;
- packet1.zgyro = packet_in.zgyro;
- packet1.xmag = packet_in.xmag;
- packet1.ymag = packet_in.ymag;
- packet1.zmag = packet_in.zmag;
- packet1.id = packet_in.id;
- packet1.temperature = packet_in.temperature;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_RAW_IMU_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_RAW_IMU_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_raw_imu_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_raw_imu_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_raw_imu_pack(system_id, component_id, &msg , packet1.time_usec , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.id , packet1.temperature );
- mavlink_msg_raw_imu_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_raw_imu_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.id , packet1.temperature );
- mavlink_msg_raw_imu_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_raw_imu_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_raw_imu_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.id , packet1.temperature );
- mavlink_msg_raw_imu_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("RAW_IMU") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_RAW_IMU) != NULL);
- #endif
- }
- static void mavlink_test_raw_pressure(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_RAW_PRESSURE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_raw_pressure_t packet_in = {
- 93372036854775807ULL,17651,17755,17859,17963
- };
- mavlink_raw_pressure_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.press_abs = packet_in.press_abs;
- packet1.press_diff1 = packet_in.press_diff1;
- packet1.press_diff2 = packet_in.press_diff2;
- packet1.temperature = packet_in.temperature;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_RAW_PRESSURE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_RAW_PRESSURE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_raw_pressure_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_raw_pressure_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_raw_pressure_pack(system_id, component_id, &msg , packet1.time_usec , packet1.press_abs , packet1.press_diff1 , packet1.press_diff2 , packet1.temperature );
- mavlink_msg_raw_pressure_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_raw_pressure_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.press_abs , packet1.press_diff1 , packet1.press_diff2 , packet1.temperature );
- mavlink_msg_raw_pressure_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_raw_pressure_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_raw_pressure_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.press_abs , packet1.press_diff1 , packet1.press_diff2 , packet1.temperature );
- mavlink_msg_raw_pressure_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("RAW_PRESSURE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_RAW_PRESSURE) != NULL);
- #endif
- }
- static void mavlink_test_scaled_pressure(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SCALED_PRESSURE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_scaled_pressure_t packet_in = {
- 963497464,45.0,73.0,17859,17963
- };
- mavlink_scaled_pressure_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.press_abs = packet_in.press_abs;
- packet1.press_diff = packet_in.press_diff;
- packet1.temperature = packet_in.temperature;
- packet1.temperature_press_diff = packet_in.temperature_press_diff;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SCALED_PRESSURE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SCALED_PRESSURE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_pressure_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_scaled_pressure_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_pressure_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.press_abs , packet1.press_diff , packet1.temperature , packet1.temperature_press_diff );
- mavlink_msg_scaled_pressure_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_pressure_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.press_abs , packet1.press_diff , packet1.temperature , packet1.temperature_press_diff );
- mavlink_msg_scaled_pressure_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_scaled_pressure_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_pressure_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.press_abs , packet1.press_diff , packet1.temperature , packet1.temperature_press_diff );
- mavlink_msg_scaled_pressure_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SCALED_PRESSURE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SCALED_PRESSURE) != NULL);
- #endif
- }
- static void mavlink_test_attitude(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ATTITUDE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_attitude_t packet_in = {
- 963497464,45.0,73.0,101.0,129.0,157.0,185.0
- };
- mavlink_attitude_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.roll = packet_in.roll;
- packet1.pitch = packet_in.pitch;
- packet1.yaw = packet_in.yaw;
- packet1.rollspeed = packet_in.rollspeed;
- packet1.pitchspeed = packet_in.pitchspeed;
- packet1.yawspeed = packet_in.yawspeed;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ATTITUDE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ATTITUDE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_attitude_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_attitude_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_attitude_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.roll , packet1.pitch , packet1.yaw , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed );
- mavlink_msg_attitude_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_attitude_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.roll , packet1.pitch , packet1.yaw , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed );
- mavlink_msg_attitude_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_attitude_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_attitude_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.roll , packet1.pitch , packet1.yaw , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed );
- mavlink_msg_attitude_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ATTITUDE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ATTITUDE) != NULL);
- #endif
- }
- static void mavlink_test_attitude_quaternion(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ATTITUDE_QUATERNION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_attitude_quaternion_t packet_in = {
- 963497464,45.0,73.0,101.0,129.0,157.0,185.0,213.0,{ 241.0, 242.0, 243.0, 244.0 }
- };
- mavlink_attitude_quaternion_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.q1 = packet_in.q1;
- packet1.q2 = packet_in.q2;
- packet1.q3 = packet_in.q3;
- packet1.q4 = packet_in.q4;
- packet1.rollspeed = packet_in.rollspeed;
- packet1.pitchspeed = packet_in.pitchspeed;
- packet1.yawspeed = packet_in.yawspeed;
-
- mav_array_memcpy(packet1.repr_offset_q, packet_in.repr_offset_q, sizeof(float)*4);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ATTITUDE_QUATERNION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ATTITUDE_QUATERNION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_attitude_quaternion_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_attitude_quaternion_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_attitude_quaternion_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.q1 , packet1.q2 , packet1.q3 , packet1.q4 , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed , packet1.repr_offset_q );
- mavlink_msg_attitude_quaternion_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_attitude_quaternion_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.q1 , packet1.q2 , packet1.q3 , packet1.q4 , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed , packet1.repr_offset_q );
- mavlink_msg_attitude_quaternion_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_attitude_quaternion_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_attitude_quaternion_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.q1 , packet1.q2 , packet1.q3 , packet1.q4 , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed , packet1.repr_offset_q );
- mavlink_msg_attitude_quaternion_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ATTITUDE_QUATERNION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ATTITUDE_QUATERNION) != NULL);
- #endif
- }
- static void mavlink_test_local_position_ned(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_LOCAL_POSITION_NED >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_local_position_ned_t packet_in = {
- 963497464,45.0,73.0,101.0,129.0,157.0,185.0
- };
- mavlink_local_position_ned_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.vx = packet_in.vx;
- packet1.vy = packet_in.vy;
- packet1.vz = packet_in.vz;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_LOCAL_POSITION_NED_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_LOCAL_POSITION_NED_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_local_position_ned_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_local_position_ned_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_local_position_ned_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.x , packet1.y , packet1.z , packet1.vx , packet1.vy , packet1.vz );
- mavlink_msg_local_position_ned_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_local_position_ned_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.x , packet1.y , packet1.z , packet1.vx , packet1.vy , packet1.vz );
- mavlink_msg_local_position_ned_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_local_position_ned_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_local_position_ned_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.x , packet1.y , packet1.z , packet1.vx , packet1.vy , packet1.vz );
- mavlink_msg_local_position_ned_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("LOCAL_POSITION_NED") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_LOCAL_POSITION_NED) != NULL);
- #endif
- }
- static void mavlink_test_global_position_int(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GLOBAL_POSITION_INT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_global_position_int_t packet_in = {
- 963497464,963497672,963497880,963498088,963498296,18275,18379,18483,18587
- };
- mavlink_global_position_int_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.alt = packet_in.alt;
- packet1.relative_alt = packet_in.relative_alt;
- packet1.vx = packet_in.vx;
- packet1.vy = packet_in.vy;
- packet1.vz = packet_in.vz;
- packet1.hdg = packet_in.hdg;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GLOBAL_POSITION_INT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GLOBAL_POSITION_INT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_global_position_int_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_global_position_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_global_position_int_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.lat , packet1.lon , packet1.alt , packet1.relative_alt , packet1.vx , packet1.vy , packet1.vz , packet1.hdg );
- mavlink_msg_global_position_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_global_position_int_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.lat , packet1.lon , packet1.alt , packet1.relative_alt , packet1.vx , packet1.vy , packet1.vz , packet1.hdg );
- mavlink_msg_global_position_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_global_position_int_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_global_position_int_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.lat , packet1.lon , packet1.alt , packet1.relative_alt , packet1.vx , packet1.vy , packet1.vz , packet1.hdg );
- mavlink_msg_global_position_int_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GLOBAL_POSITION_INT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GLOBAL_POSITION_INT) != NULL);
- #endif
- }
- static void mavlink_test_rc_channels_scaled(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_RC_CHANNELS_SCALED >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_rc_channels_scaled_t packet_in = {
- 963497464,17443,17547,17651,17755,17859,17963,18067,18171,65,132
- };
- mavlink_rc_channels_scaled_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.chan1_scaled = packet_in.chan1_scaled;
- packet1.chan2_scaled = packet_in.chan2_scaled;
- packet1.chan3_scaled = packet_in.chan3_scaled;
- packet1.chan4_scaled = packet_in.chan4_scaled;
- packet1.chan5_scaled = packet_in.chan5_scaled;
- packet1.chan6_scaled = packet_in.chan6_scaled;
- packet1.chan7_scaled = packet_in.chan7_scaled;
- packet1.chan8_scaled = packet_in.chan8_scaled;
- packet1.port = packet_in.port;
- packet1.rssi = packet_in.rssi;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_RC_CHANNELS_SCALED_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_RC_CHANNELS_SCALED_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_rc_channels_scaled_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_rc_channels_scaled_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_rc_channels_scaled_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.port , packet1.chan1_scaled , packet1.chan2_scaled , packet1.chan3_scaled , packet1.chan4_scaled , packet1.chan5_scaled , packet1.chan6_scaled , packet1.chan7_scaled , packet1.chan8_scaled , packet1.rssi );
- mavlink_msg_rc_channels_scaled_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_rc_channels_scaled_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.port , packet1.chan1_scaled , packet1.chan2_scaled , packet1.chan3_scaled , packet1.chan4_scaled , packet1.chan5_scaled , packet1.chan6_scaled , packet1.chan7_scaled , packet1.chan8_scaled , packet1.rssi );
- mavlink_msg_rc_channels_scaled_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_rc_channels_scaled_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_rc_channels_scaled_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.port , packet1.chan1_scaled , packet1.chan2_scaled , packet1.chan3_scaled , packet1.chan4_scaled , packet1.chan5_scaled , packet1.chan6_scaled , packet1.chan7_scaled , packet1.chan8_scaled , packet1.rssi );
- mavlink_msg_rc_channels_scaled_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("RC_CHANNELS_SCALED") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_RC_CHANNELS_SCALED) != NULL);
- #endif
- }
- static void mavlink_test_rc_channels_raw(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_RC_CHANNELS_RAW >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_rc_channels_raw_t packet_in = {
- 963497464,17443,17547,17651,17755,17859,17963,18067,18171,65,132
- };
- mavlink_rc_channels_raw_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.chan1_raw = packet_in.chan1_raw;
- packet1.chan2_raw = packet_in.chan2_raw;
- packet1.chan3_raw = packet_in.chan3_raw;
- packet1.chan4_raw = packet_in.chan4_raw;
- packet1.chan5_raw = packet_in.chan5_raw;
- packet1.chan6_raw = packet_in.chan6_raw;
- packet1.chan7_raw = packet_in.chan7_raw;
- packet1.chan8_raw = packet_in.chan8_raw;
- packet1.port = packet_in.port;
- packet1.rssi = packet_in.rssi;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_RC_CHANNELS_RAW_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_RC_CHANNELS_RAW_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_rc_channels_raw_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_rc_channels_raw_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_rc_channels_raw_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.port , packet1.chan1_raw , packet1.chan2_raw , packet1.chan3_raw , packet1.chan4_raw , packet1.chan5_raw , packet1.chan6_raw , packet1.chan7_raw , packet1.chan8_raw , packet1.rssi );
- mavlink_msg_rc_channels_raw_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_rc_channels_raw_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.port , packet1.chan1_raw , packet1.chan2_raw , packet1.chan3_raw , packet1.chan4_raw , packet1.chan5_raw , packet1.chan6_raw , packet1.chan7_raw , packet1.chan8_raw , packet1.rssi );
- mavlink_msg_rc_channels_raw_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_rc_channels_raw_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_rc_channels_raw_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.port , packet1.chan1_raw , packet1.chan2_raw , packet1.chan3_raw , packet1.chan4_raw , packet1.chan5_raw , packet1.chan6_raw , packet1.chan7_raw , packet1.chan8_raw , packet1.rssi );
- mavlink_msg_rc_channels_raw_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("RC_CHANNELS_RAW") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_RC_CHANNELS_RAW) != NULL);
- #endif
- }
- static void mavlink_test_servo_output_raw(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SERVO_OUTPUT_RAW >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_servo_output_raw_t packet_in = {
- 963497464,17443,17547,17651,17755,17859,17963,18067,18171,65,18327,18431,18535,18639,18743,18847,18951,19055
- };
- mavlink_servo_output_raw_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.servo1_raw = packet_in.servo1_raw;
- packet1.servo2_raw = packet_in.servo2_raw;
- packet1.servo3_raw = packet_in.servo3_raw;
- packet1.servo4_raw = packet_in.servo4_raw;
- packet1.servo5_raw = packet_in.servo5_raw;
- packet1.servo6_raw = packet_in.servo6_raw;
- packet1.servo7_raw = packet_in.servo7_raw;
- packet1.servo8_raw = packet_in.servo8_raw;
- packet1.port = packet_in.port;
- packet1.servo9_raw = packet_in.servo9_raw;
- packet1.servo10_raw = packet_in.servo10_raw;
- packet1.servo11_raw = packet_in.servo11_raw;
- packet1.servo12_raw = packet_in.servo12_raw;
- packet1.servo13_raw = packet_in.servo13_raw;
- packet1.servo14_raw = packet_in.servo14_raw;
- packet1.servo15_raw = packet_in.servo15_raw;
- packet1.servo16_raw = packet_in.servo16_raw;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SERVO_OUTPUT_RAW_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SERVO_OUTPUT_RAW_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_servo_output_raw_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_servo_output_raw_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_servo_output_raw_pack(system_id, component_id, &msg , packet1.time_usec , packet1.port , packet1.servo1_raw , packet1.servo2_raw , packet1.servo3_raw , packet1.servo4_raw , packet1.servo5_raw , packet1.servo6_raw , packet1.servo7_raw , packet1.servo8_raw , packet1.servo9_raw , packet1.servo10_raw , packet1.servo11_raw , packet1.servo12_raw , packet1.servo13_raw , packet1.servo14_raw , packet1.servo15_raw , packet1.servo16_raw );
- mavlink_msg_servo_output_raw_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_servo_output_raw_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.port , packet1.servo1_raw , packet1.servo2_raw , packet1.servo3_raw , packet1.servo4_raw , packet1.servo5_raw , packet1.servo6_raw , packet1.servo7_raw , packet1.servo8_raw , packet1.servo9_raw , packet1.servo10_raw , packet1.servo11_raw , packet1.servo12_raw , packet1.servo13_raw , packet1.servo14_raw , packet1.servo15_raw , packet1.servo16_raw );
- mavlink_msg_servo_output_raw_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_servo_output_raw_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_servo_output_raw_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.port , packet1.servo1_raw , packet1.servo2_raw , packet1.servo3_raw , packet1.servo4_raw , packet1.servo5_raw , packet1.servo6_raw , packet1.servo7_raw , packet1.servo8_raw , packet1.servo9_raw , packet1.servo10_raw , packet1.servo11_raw , packet1.servo12_raw , packet1.servo13_raw , packet1.servo14_raw , packet1.servo15_raw , packet1.servo16_raw );
- mavlink_msg_servo_output_raw_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SERVO_OUTPUT_RAW") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SERVO_OUTPUT_RAW) != NULL);
- #endif
- }
- static void mavlink_test_mission_request_partial_list(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MISSION_REQUEST_PARTIAL_LIST >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_mission_request_partial_list_t packet_in = {
- 17235,17339,17,84,151
- };
- mavlink_mission_request_partial_list_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.start_index = packet_in.start_index;
- packet1.end_index = packet_in.end_index;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.mission_type = packet_in.mission_type;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MISSION_REQUEST_PARTIAL_LIST_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MISSION_REQUEST_PARTIAL_LIST_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_request_partial_list_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_mission_request_partial_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_request_partial_list_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.start_index , packet1.end_index , packet1.mission_type );
- mavlink_msg_mission_request_partial_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_request_partial_list_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.start_index , packet1.end_index , packet1.mission_type );
- mavlink_msg_mission_request_partial_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_mission_request_partial_list_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_request_partial_list_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.start_index , packet1.end_index , packet1.mission_type );
- mavlink_msg_mission_request_partial_list_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MISSION_REQUEST_PARTIAL_LIST") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MISSION_REQUEST_PARTIAL_LIST) != NULL);
- #endif
- }
- static void mavlink_test_mission_write_partial_list(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MISSION_WRITE_PARTIAL_LIST >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_mission_write_partial_list_t packet_in = {
- 17235,17339,17,84,151
- };
- mavlink_mission_write_partial_list_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.start_index = packet_in.start_index;
- packet1.end_index = packet_in.end_index;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.mission_type = packet_in.mission_type;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MISSION_WRITE_PARTIAL_LIST_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MISSION_WRITE_PARTIAL_LIST_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_write_partial_list_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_mission_write_partial_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_write_partial_list_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.start_index , packet1.end_index , packet1.mission_type );
- mavlink_msg_mission_write_partial_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_write_partial_list_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.start_index , packet1.end_index , packet1.mission_type );
- mavlink_msg_mission_write_partial_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_mission_write_partial_list_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_write_partial_list_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.start_index , packet1.end_index , packet1.mission_type );
- mavlink_msg_mission_write_partial_list_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MISSION_WRITE_PARTIAL_LIST") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MISSION_WRITE_PARTIAL_LIST) != NULL);
- #endif
- }
- static void mavlink_test_mission_item(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MISSION_ITEM >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_mission_item_t packet_in = {
- 17.0,45.0,73.0,101.0,129.0,157.0,185.0,18691,18795,101,168,235,46,113,180
- };
- mavlink_mission_item_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.param1 = packet_in.param1;
- packet1.param2 = packet_in.param2;
- packet1.param3 = packet_in.param3;
- packet1.param4 = packet_in.param4;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.seq = packet_in.seq;
- packet1.command = packet_in.command;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.frame = packet_in.frame;
- packet1.current = packet_in.current;
- packet1.autocontinue = packet_in.autocontinue;
- packet1.mission_type = packet_in.mission_type;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MISSION_ITEM_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MISSION_ITEM_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_item_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_mission_item_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_item_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.seq , packet1.frame , packet1.command , packet1.current , packet1.autocontinue , packet1.param1 , packet1.param2 , packet1.param3 , packet1.param4 , packet1.x , packet1.y , packet1.z , packet1.mission_type );
- mavlink_msg_mission_item_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_item_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.seq , packet1.frame , packet1.command , packet1.current , packet1.autocontinue , packet1.param1 , packet1.param2 , packet1.param3 , packet1.param4 , packet1.x , packet1.y , packet1.z , packet1.mission_type );
- mavlink_msg_mission_item_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_mission_item_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_item_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.seq , packet1.frame , packet1.command , packet1.current , packet1.autocontinue , packet1.param1 , packet1.param2 , packet1.param3 , packet1.param4 , packet1.x , packet1.y , packet1.z , packet1.mission_type );
- mavlink_msg_mission_item_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MISSION_ITEM") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MISSION_ITEM) != NULL);
- #endif
- }
- static void mavlink_test_mission_request(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MISSION_REQUEST >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_mission_request_t packet_in = {
- 17235,139,206,17
- };
- mavlink_mission_request_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.seq = packet_in.seq;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.mission_type = packet_in.mission_type;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MISSION_REQUEST_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MISSION_REQUEST_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_request_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_mission_request_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_request_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.seq , packet1.mission_type );
- mavlink_msg_mission_request_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_request_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.seq , packet1.mission_type );
- mavlink_msg_mission_request_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_mission_request_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_request_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.seq , packet1.mission_type );
- mavlink_msg_mission_request_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MISSION_REQUEST") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MISSION_REQUEST) != NULL);
- #endif
- }
- static void mavlink_test_mission_set_current(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MISSION_SET_CURRENT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_mission_set_current_t packet_in = {
- 17235,139,206
- };
- mavlink_mission_set_current_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.seq = packet_in.seq;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MISSION_SET_CURRENT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MISSION_SET_CURRENT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_set_current_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_mission_set_current_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_set_current_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.seq );
- mavlink_msg_mission_set_current_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_set_current_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.seq );
- mavlink_msg_mission_set_current_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_mission_set_current_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_set_current_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.seq );
- mavlink_msg_mission_set_current_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MISSION_SET_CURRENT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MISSION_SET_CURRENT) != NULL);
- #endif
- }
- static void mavlink_test_mission_current(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MISSION_CURRENT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_mission_current_t packet_in = {
- 17235,17339,17,84,963497776,963497984,963498192
- };
- mavlink_mission_current_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.seq = packet_in.seq;
- packet1.total = packet_in.total;
- packet1.mission_state = packet_in.mission_state;
- packet1.mission_mode = packet_in.mission_mode;
- packet1.mission_id = packet_in.mission_id;
- packet1.fence_id = packet_in.fence_id;
- packet1.rally_points_id = packet_in.rally_points_id;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MISSION_CURRENT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MISSION_CURRENT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_current_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_mission_current_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_current_pack(system_id, component_id, &msg , packet1.seq , packet1.total , packet1.mission_state , packet1.mission_mode , packet1.mission_id , packet1.fence_id , packet1.rally_points_id );
- mavlink_msg_mission_current_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_current_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.seq , packet1.total , packet1.mission_state , packet1.mission_mode , packet1.mission_id , packet1.fence_id , packet1.rally_points_id );
- mavlink_msg_mission_current_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_mission_current_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_current_send(MAVLINK_COMM_1 , packet1.seq , packet1.total , packet1.mission_state , packet1.mission_mode , packet1.mission_id , packet1.fence_id , packet1.rally_points_id );
- mavlink_msg_mission_current_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MISSION_CURRENT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MISSION_CURRENT) != NULL);
- #endif
- }
- static void mavlink_test_mission_request_list(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MISSION_REQUEST_LIST >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_mission_request_list_t packet_in = {
- 5,72,139
- };
- mavlink_mission_request_list_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.mission_type = packet_in.mission_type;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MISSION_REQUEST_LIST_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MISSION_REQUEST_LIST_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_request_list_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_mission_request_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_request_list_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.mission_type );
- mavlink_msg_mission_request_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_request_list_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.mission_type );
- mavlink_msg_mission_request_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_mission_request_list_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_request_list_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.mission_type );
- mavlink_msg_mission_request_list_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MISSION_REQUEST_LIST") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MISSION_REQUEST_LIST) != NULL);
- #endif
- }
- static void mavlink_test_mission_count(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MISSION_COUNT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_mission_count_t packet_in = {
- 17235,139,206,17,963497724
- };
- mavlink_mission_count_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.count = packet_in.count;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.mission_type = packet_in.mission_type;
- packet1.opaque_id = packet_in.opaque_id;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MISSION_COUNT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MISSION_COUNT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_count_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_mission_count_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_count_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.count , packet1.mission_type , packet1.opaque_id );
- mavlink_msg_mission_count_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_count_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.count , packet1.mission_type , packet1.opaque_id );
- mavlink_msg_mission_count_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_mission_count_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_count_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.count , packet1.mission_type , packet1.opaque_id );
- mavlink_msg_mission_count_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MISSION_COUNT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MISSION_COUNT) != NULL);
- #endif
- }
- static void mavlink_test_mission_clear_all(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MISSION_CLEAR_ALL >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_mission_clear_all_t packet_in = {
- 5,72,139
- };
- mavlink_mission_clear_all_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.mission_type = packet_in.mission_type;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MISSION_CLEAR_ALL_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MISSION_CLEAR_ALL_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_clear_all_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_mission_clear_all_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_clear_all_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.mission_type );
- mavlink_msg_mission_clear_all_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_clear_all_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.mission_type );
- mavlink_msg_mission_clear_all_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_mission_clear_all_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_clear_all_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.mission_type );
- mavlink_msg_mission_clear_all_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MISSION_CLEAR_ALL") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MISSION_CLEAR_ALL) != NULL);
- #endif
- }
- static void mavlink_test_mission_item_reached(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MISSION_ITEM_REACHED >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_mission_item_reached_t packet_in = {
- 17235
- };
- mavlink_mission_item_reached_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.seq = packet_in.seq;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MISSION_ITEM_REACHED_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MISSION_ITEM_REACHED_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_item_reached_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_mission_item_reached_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_item_reached_pack(system_id, component_id, &msg , packet1.seq );
- mavlink_msg_mission_item_reached_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_item_reached_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.seq );
- mavlink_msg_mission_item_reached_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_mission_item_reached_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_item_reached_send(MAVLINK_COMM_1 , packet1.seq );
- mavlink_msg_mission_item_reached_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MISSION_ITEM_REACHED") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MISSION_ITEM_REACHED) != NULL);
- #endif
- }
- static void mavlink_test_mission_ack(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MISSION_ACK >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_mission_ack_t packet_in = {
- 5,72,139,206,963497672
- };
- mavlink_mission_ack_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.type = packet_in.type;
- packet1.mission_type = packet_in.mission_type;
- packet1.opaque_id = packet_in.opaque_id;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MISSION_ACK_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MISSION_ACK_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_ack_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_mission_ack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_ack_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.type , packet1.mission_type , packet1.opaque_id );
- mavlink_msg_mission_ack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_ack_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.type , packet1.mission_type , packet1.opaque_id );
- mavlink_msg_mission_ack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_mission_ack_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_ack_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.type , packet1.mission_type , packet1.opaque_id );
- mavlink_msg_mission_ack_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MISSION_ACK") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MISSION_ACK) != NULL);
- #endif
- }
- static void mavlink_test_set_gps_global_origin(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SET_GPS_GLOBAL_ORIGIN >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_set_gps_global_origin_t packet_in = {
- 963497464,963497672,963497880,41,93372036854776626ULL
- };
- mavlink_set_gps_global_origin_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.latitude = packet_in.latitude;
- packet1.longitude = packet_in.longitude;
- packet1.altitude = packet_in.altitude;
- packet1.target_system = packet_in.target_system;
- packet1.time_usec = packet_in.time_usec;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SET_GPS_GLOBAL_ORIGIN_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SET_GPS_GLOBAL_ORIGIN_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_gps_global_origin_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_set_gps_global_origin_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_gps_global_origin_pack(system_id, component_id, &msg , packet1.target_system , packet1.latitude , packet1.longitude , packet1.altitude , packet1.time_usec );
- mavlink_msg_set_gps_global_origin_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_gps_global_origin_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.latitude , packet1.longitude , packet1.altitude , packet1.time_usec );
- mavlink_msg_set_gps_global_origin_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_set_gps_global_origin_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_gps_global_origin_send(MAVLINK_COMM_1 , packet1.target_system , packet1.latitude , packet1.longitude , packet1.altitude , packet1.time_usec );
- mavlink_msg_set_gps_global_origin_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SET_GPS_GLOBAL_ORIGIN") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SET_GPS_GLOBAL_ORIGIN) != NULL);
- #endif
- }
- static void mavlink_test_gps_global_origin(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GPS_GLOBAL_ORIGIN >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gps_global_origin_t packet_in = {
- 963497464,963497672,963497880,93372036854776563ULL
- };
- mavlink_gps_global_origin_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.latitude = packet_in.latitude;
- packet1.longitude = packet_in.longitude;
- packet1.altitude = packet_in.altitude;
- packet1.time_usec = packet_in.time_usec;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GPS_GLOBAL_ORIGIN_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GPS_GLOBAL_ORIGIN_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_global_origin_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gps_global_origin_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_global_origin_pack(system_id, component_id, &msg , packet1.latitude , packet1.longitude , packet1.altitude , packet1.time_usec );
- mavlink_msg_gps_global_origin_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_global_origin_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.latitude , packet1.longitude , packet1.altitude , packet1.time_usec );
- mavlink_msg_gps_global_origin_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gps_global_origin_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_global_origin_send(MAVLINK_COMM_1 , packet1.latitude , packet1.longitude , packet1.altitude , packet1.time_usec );
- mavlink_msg_gps_global_origin_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GPS_GLOBAL_ORIGIN") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GPS_GLOBAL_ORIGIN) != NULL);
- #endif
- }
- static void mavlink_test_param_map_rc(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_PARAM_MAP_RC >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_param_map_rc_t packet_in = {
- 17.0,45.0,73.0,101.0,18067,187,254,"UVWXYZABCDEFGHI",113
- };
- mavlink_param_map_rc_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.param_value0 = packet_in.param_value0;
- packet1.scale = packet_in.scale;
- packet1.param_value_min = packet_in.param_value_min;
- packet1.param_value_max = packet_in.param_value_max;
- packet1.param_index = packet_in.param_index;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.parameter_rc_channel_index = packet_in.parameter_rc_channel_index;
-
- mav_array_memcpy(packet1.param_id, packet_in.param_id, sizeof(char)*16);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_PARAM_MAP_RC_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_PARAM_MAP_RC_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_map_rc_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_param_map_rc_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_map_rc_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.param_id , packet1.param_index , packet1.parameter_rc_channel_index , packet1.param_value0 , packet1.scale , packet1.param_value_min , packet1.param_value_max );
- mavlink_msg_param_map_rc_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_map_rc_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.param_id , packet1.param_index , packet1.parameter_rc_channel_index , packet1.param_value0 , packet1.scale , packet1.param_value_min , packet1.param_value_max );
- mavlink_msg_param_map_rc_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_param_map_rc_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_map_rc_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.param_id , packet1.param_index , packet1.parameter_rc_channel_index , packet1.param_value0 , packet1.scale , packet1.param_value_min , packet1.param_value_max );
- mavlink_msg_param_map_rc_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("PARAM_MAP_RC") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_PARAM_MAP_RC) != NULL);
- #endif
- }
- static void mavlink_test_mission_request_int(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MISSION_REQUEST_INT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_mission_request_int_t packet_in = {
- 17235,139,206,17
- };
- mavlink_mission_request_int_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.seq = packet_in.seq;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.mission_type = packet_in.mission_type;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MISSION_REQUEST_INT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MISSION_REQUEST_INT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_request_int_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_mission_request_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_request_int_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.seq , packet1.mission_type );
- mavlink_msg_mission_request_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_request_int_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.seq , packet1.mission_type );
- mavlink_msg_mission_request_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_mission_request_int_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_request_int_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.seq , packet1.mission_type );
- mavlink_msg_mission_request_int_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MISSION_REQUEST_INT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MISSION_REQUEST_INT) != NULL);
- #endif
- }
- static void mavlink_test_safety_set_allowed_area(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SAFETY_SET_ALLOWED_AREA >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_safety_set_allowed_area_t packet_in = {
- 17.0,45.0,73.0,101.0,129.0,157.0,77,144,211
- };
- mavlink_safety_set_allowed_area_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.p1x = packet_in.p1x;
- packet1.p1y = packet_in.p1y;
- packet1.p1z = packet_in.p1z;
- packet1.p2x = packet_in.p2x;
- packet1.p2y = packet_in.p2y;
- packet1.p2z = packet_in.p2z;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.frame = packet_in.frame;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SAFETY_SET_ALLOWED_AREA_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SAFETY_SET_ALLOWED_AREA_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_safety_set_allowed_area_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_safety_set_allowed_area_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_safety_set_allowed_area_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.frame , packet1.p1x , packet1.p1y , packet1.p1z , packet1.p2x , packet1.p2y , packet1.p2z );
- mavlink_msg_safety_set_allowed_area_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_safety_set_allowed_area_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.frame , packet1.p1x , packet1.p1y , packet1.p1z , packet1.p2x , packet1.p2y , packet1.p2z );
- mavlink_msg_safety_set_allowed_area_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_safety_set_allowed_area_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_safety_set_allowed_area_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.frame , packet1.p1x , packet1.p1y , packet1.p1z , packet1.p2x , packet1.p2y , packet1.p2z );
- mavlink_msg_safety_set_allowed_area_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SAFETY_SET_ALLOWED_AREA") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SAFETY_SET_ALLOWED_AREA) != NULL);
- #endif
- }
- static void mavlink_test_safety_allowed_area(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SAFETY_ALLOWED_AREA >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_safety_allowed_area_t packet_in = {
- 17.0,45.0,73.0,101.0,129.0,157.0,77
- };
- mavlink_safety_allowed_area_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.p1x = packet_in.p1x;
- packet1.p1y = packet_in.p1y;
- packet1.p1z = packet_in.p1z;
- packet1.p2x = packet_in.p2x;
- packet1.p2y = packet_in.p2y;
- packet1.p2z = packet_in.p2z;
- packet1.frame = packet_in.frame;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SAFETY_ALLOWED_AREA_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SAFETY_ALLOWED_AREA_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_safety_allowed_area_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_safety_allowed_area_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_safety_allowed_area_pack(system_id, component_id, &msg , packet1.frame , packet1.p1x , packet1.p1y , packet1.p1z , packet1.p2x , packet1.p2y , packet1.p2z );
- mavlink_msg_safety_allowed_area_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_safety_allowed_area_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.frame , packet1.p1x , packet1.p1y , packet1.p1z , packet1.p2x , packet1.p2y , packet1.p2z );
- mavlink_msg_safety_allowed_area_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_safety_allowed_area_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_safety_allowed_area_send(MAVLINK_COMM_1 , packet1.frame , packet1.p1x , packet1.p1y , packet1.p1z , packet1.p2x , packet1.p2y , packet1.p2z );
- mavlink_msg_safety_allowed_area_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SAFETY_ALLOWED_AREA") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SAFETY_ALLOWED_AREA) != NULL);
- #endif
- }
- static void mavlink_test_attitude_quaternion_cov(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ATTITUDE_QUATERNION_COV >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_attitude_quaternion_cov_t packet_in = {
- 93372036854775807ULL,{ 73.0, 74.0, 75.0, 76.0 },185.0,213.0,241.0,{ 269.0, 270.0, 271.0, 272.0, 273.0, 274.0, 275.0, 276.0, 277.0 }
- };
- mavlink_attitude_quaternion_cov_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.rollspeed = packet_in.rollspeed;
- packet1.pitchspeed = packet_in.pitchspeed;
- packet1.yawspeed = packet_in.yawspeed;
-
- mav_array_memcpy(packet1.q, packet_in.q, sizeof(float)*4);
- mav_array_memcpy(packet1.covariance, packet_in.covariance, sizeof(float)*9);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ATTITUDE_QUATERNION_COV_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ATTITUDE_QUATERNION_COV_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_attitude_quaternion_cov_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_attitude_quaternion_cov_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_attitude_quaternion_cov_pack(system_id, component_id, &msg , packet1.time_usec , packet1.q , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed , packet1.covariance );
- mavlink_msg_attitude_quaternion_cov_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_attitude_quaternion_cov_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.q , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed , packet1.covariance );
- mavlink_msg_attitude_quaternion_cov_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_attitude_quaternion_cov_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_attitude_quaternion_cov_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.q , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed , packet1.covariance );
- mavlink_msg_attitude_quaternion_cov_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ATTITUDE_QUATERNION_COV") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ATTITUDE_QUATERNION_COV) != NULL);
- #endif
- }
- static void mavlink_test_nav_controller_output(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_NAV_CONTROLLER_OUTPUT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_nav_controller_output_t packet_in = {
- 17.0,45.0,73.0,101.0,129.0,18275,18379,18483
- };
- mavlink_nav_controller_output_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.nav_roll = packet_in.nav_roll;
- packet1.nav_pitch = packet_in.nav_pitch;
- packet1.alt_error = packet_in.alt_error;
- packet1.aspd_error = packet_in.aspd_error;
- packet1.xtrack_error = packet_in.xtrack_error;
- packet1.nav_bearing = packet_in.nav_bearing;
- packet1.target_bearing = packet_in.target_bearing;
- packet1.wp_dist = packet_in.wp_dist;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_NAV_CONTROLLER_OUTPUT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_NAV_CONTROLLER_OUTPUT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_nav_controller_output_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_nav_controller_output_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_nav_controller_output_pack(system_id, component_id, &msg , packet1.nav_roll , packet1.nav_pitch , packet1.nav_bearing , packet1.target_bearing , packet1.wp_dist , packet1.alt_error , packet1.aspd_error , packet1.xtrack_error );
- mavlink_msg_nav_controller_output_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_nav_controller_output_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.nav_roll , packet1.nav_pitch , packet1.nav_bearing , packet1.target_bearing , packet1.wp_dist , packet1.alt_error , packet1.aspd_error , packet1.xtrack_error );
- mavlink_msg_nav_controller_output_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_nav_controller_output_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_nav_controller_output_send(MAVLINK_COMM_1 , packet1.nav_roll , packet1.nav_pitch , packet1.nav_bearing , packet1.target_bearing , packet1.wp_dist , packet1.alt_error , packet1.aspd_error , packet1.xtrack_error );
- mavlink_msg_nav_controller_output_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("NAV_CONTROLLER_OUTPUT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_NAV_CONTROLLER_OUTPUT) != NULL);
- #endif
- }
- static void mavlink_test_global_position_int_cov(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GLOBAL_POSITION_INT_COV >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_global_position_int_cov_t packet_in = {
- 93372036854775807ULL,963497880,963498088,963498296,963498504,185.0,213.0,241.0,{ 269.0, 270.0, 271.0, 272.0, 273.0, 274.0, 275.0, 276.0, 277.0, 278.0, 279.0, 280.0, 281.0, 282.0, 283.0, 284.0, 285.0, 286.0, 287.0, 288.0, 289.0, 290.0, 291.0, 292.0, 293.0, 294.0, 295.0, 296.0, 297.0, 298.0, 299.0, 300.0, 301.0, 302.0, 303.0, 304.0 },33
- };
- mavlink_global_position_int_cov_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.alt = packet_in.alt;
- packet1.relative_alt = packet_in.relative_alt;
- packet1.vx = packet_in.vx;
- packet1.vy = packet_in.vy;
- packet1.vz = packet_in.vz;
- packet1.estimator_type = packet_in.estimator_type;
-
- mav_array_memcpy(packet1.covariance, packet_in.covariance, sizeof(float)*36);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GLOBAL_POSITION_INT_COV_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GLOBAL_POSITION_INT_COV_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_global_position_int_cov_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_global_position_int_cov_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_global_position_int_cov_pack(system_id, component_id, &msg , packet1.time_usec , packet1.estimator_type , packet1.lat , packet1.lon , packet1.alt , packet1.relative_alt , packet1.vx , packet1.vy , packet1.vz , packet1.covariance );
- mavlink_msg_global_position_int_cov_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_global_position_int_cov_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.estimator_type , packet1.lat , packet1.lon , packet1.alt , packet1.relative_alt , packet1.vx , packet1.vy , packet1.vz , packet1.covariance );
- mavlink_msg_global_position_int_cov_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_global_position_int_cov_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_global_position_int_cov_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.estimator_type , packet1.lat , packet1.lon , packet1.alt , packet1.relative_alt , packet1.vx , packet1.vy , packet1.vz , packet1.covariance );
- mavlink_msg_global_position_int_cov_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GLOBAL_POSITION_INT_COV") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GLOBAL_POSITION_INT_COV) != NULL);
- #endif
- }
- static void mavlink_test_local_position_ned_cov(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_local_position_ned_cov_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,157.0,185.0,213.0,241.0,269.0,297.0,{ 325.0, 326.0, 327.0, 328.0, 329.0, 330.0, 331.0, 332.0, 333.0, 334.0, 335.0, 336.0, 337.0, 338.0, 339.0, 340.0, 341.0, 342.0, 343.0, 344.0, 345.0, 346.0, 347.0, 348.0, 349.0, 350.0, 351.0, 352.0, 353.0, 354.0, 355.0, 356.0, 357.0, 358.0, 359.0, 360.0, 361.0, 362.0, 363.0, 364.0, 365.0, 366.0, 367.0, 368.0, 369.0 },165
- };
- mavlink_local_position_ned_cov_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.vx = packet_in.vx;
- packet1.vy = packet_in.vy;
- packet1.vz = packet_in.vz;
- packet1.ax = packet_in.ax;
- packet1.ay = packet_in.ay;
- packet1.az = packet_in.az;
- packet1.estimator_type = packet_in.estimator_type;
-
- mav_array_memcpy(packet1.covariance, packet_in.covariance, sizeof(float)*45);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_local_position_ned_cov_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_local_position_ned_cov_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_local_position_ned_cov_pack(system_id, component_id, &msg , packet1.time_usec , packet1.estimator_type , packet1.x , packet1.y , packet1.z , packet1.vx , packet1.vy , packet1.vz , packet1.ax , packet1.ay , packet1.az , packet1.covariance );
- mavlink_msg_local_position_ned_cov_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_local_position_ned_cov_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.estimator_type , packet1.x , packet1.y , packet1.z , packet1.vx , packet1.vy , packet1.vz , packet1.ax , packet1.ay , packet1.az , packet1.covariance );
- mavlink_msg_local_position_ned_cov_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_local_position_ned_cov_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_local_position_ned_cov_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.estimator_type , packet1.x , packet1.y , packet1.z , packet1.vx , packet1.vy , packet1.vz , packet1.ax , packet1.ay , packet1.az , packet1.covariance );
- mavlink_msg_local_position_ned_cov_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("LOCAL_POSITION_NED_COV") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_LOCAL_POSITION_NED_COV) != NULL);
- #endif
- }
- static void mavlink_test_rc_channels(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_RC_CHANNELS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_rc_channels_t packet_in = {
- 963497464,17443,17547,17651,17755,17859,17963,18067,18171,18275,18379,18483,18587,18691,18795,18899,19003,19107,19211,125,192
- };
- mavlink_rc_channels_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.chan1_raw = packet_in.chan1_raw;
- packet1.chan2_raw = packet_in.chan2_raw;
- packet1.chan3_raw = packet_in.chan3_raw;
- packet1.chan4_raw = packet_in.chan4_raw;
- packet1.chan5_raw = packet_in.chan5_raw;
- packet1.chan6_raw = packet_in.chan6_raw;
- packet1.chan7_raw = packet_in.chan7_raw;
- packet1.chan8_raw = packet_in.chan8_raw;
- packet1.chan9_raw = packet_in.chan9_raw;
- packet1.chan10_raw = packet_in.chan10_raw;
- packet1.chan11_raw = packet_in.chan11_raw;
- packet1.chan12_raw = packet_in.chan12_raw;
- packet1.chan13_raw = packet_in.chan13_raw;
- packet1.chan14_raw = packet_in.chan14_raw;
- packet1.chan15_raw = packet_in.chan15_raw;
- packet1.chan16_raw = packet_in.chan16_raw;
- packet1.chan17_raw = packet_in.chan17_raw;
- packet1.chan18_raw = packet_in.chan18_raw;
- packet1.chancount = packet_in.chancount;
- packet1.rssi = packet_in.rssi;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_RC_CHANNELS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_RC_CHANNELS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_rc_channels_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_rc_channels_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_rc_channels_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.chancount , packet1.chan1_raw , packet1.chan2_raw , packet1.chan3_raw , packet1.chan4_raw , packet1.chan5_raw , packet1.chan6_raw , packet1.chan7_raw , packet1.chan8_raw , packet1.chan9_raw , packet1.chan10_raw , packet1.chan11_raw , packet1.chan12_raw , packet1.chan13_raw , packet1.chan14_raw , packet1.chan15_raw , packet1.chan16_raw , packet1.chan17_raw , packet1.chan18_raw , packet1.rssi );
- mavlink_msg_rc_channels_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_rc_channels_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.chancount , packet1.chan1_raw , packet1.chan2_raw , packet1.chan3_raw , packet1.chan4_raw , packet1.chan5_raw , packet1.chan6_raw , packet1.chan7_raw , packet1.chan8_raw , packet1.chan9_raw , packet1.chan10_raw , packet1.chan11_raw , packet1.chan12_raw , packet1.chan13_raw , packet1.chan14_raw , packet1.chan15_raw , packet1.chan16_raw , packet1.chan17_raw , packet1.chan18_raw , packet1.rssi );
- mavlink_msg_rc_channels_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_rc_channels_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_rc_channels_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.chancount , packet1.chan1_raw , packet1.chan2_raw , packet1.chan3_raw , packet1.chan4_raw , packet1.chan5_raw , packet1.chan6_raw , packet1.chan7_raw , packet1.chan8_raw , packet1.chan9_raw , packet1.chan10_raw , packet1.chan11_raw , packet1.chan12_raw , packet1.chan13_raw , packet1.chan14_raw , packet1.chan15_raw , packet1.chan16_raw , packet1.chan17_raw , packet1.chan18_raw , packet1.rssi );
- mavlink_msg_rc_channels_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("RC_CHANNELS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_RC_CHANNELS) != NULL);
- #endif
- }
- static void mavlink_test_request_data_stream(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_REQUEST_DATA_STREAM >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_request_data_stream_t packet_in = {
- 17235,139,206,17,84
- };
- mavlink_request_data_stream_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.req_message_rate = packet_in.req_message_rate;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.req_stream_id = packet_in.req_stream_id;
- packet1.start_stop = packet_in.start_stop;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_REQUEST_DATA_STREAM_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_REQUEST_DATA_STREAM_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_request_data_stream_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_request_data_stream_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_request_data_stream_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.req_stream_id , packet1.req_message_rate , packet1.start_stop );
- mavlink_msg_request_data_stream_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_request_data_stream_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.req_stream_id , packet1.req_message_rate , packet1.start_stop );
- mavlink_msg_request_data_stream_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_request_data_stream_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_request_data_stream_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.req_stream_id , packet1.req_message_rate , packet1.start_stop );
- mavlink_msg_request_data_stream_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("REQUEST_DATA_STREAM") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_REQUEST_DATA_STREAM) != NULL);
- #endif
- }
- static void mavlink_test_data_stream(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_DATA_STREAM >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_data_stream_t packet_in = {
- 17235,139,206
- };
- mavlink_data_stream_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.message_rate = packet_in.message_rate;
- packet1.stream_id = packet_in.stream_id;
- packet1.on_off = packet_in.on_off;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_DATA_STREAM_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_DATA_STREAM_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_data_stream_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_data_stream_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_data_stream_pack(system_id, component_id, &msg , packet1.stream_id , packet1.message_rate , packet1.on_off );
- mavlink_msg_data_stream_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_data_stream_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.stream_id , packet1.message_rate , packet1.on_off );
- mavlink_msg_data_stream_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_data_stream_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_data_stream_send(MAVLINK_COMM_1 , packet1.stream_id , packet1.message_rate , packet1.on_off );
- mavlink_msg_data_stream_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("DATA_STREAM") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_DATA_STREAM) != NULL);
- #endif
- }
- static void mavlink_test_manual_control(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MANUAL_CONTROL >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_manual_control_t packet_in = {
- 17235,17339,17443,17547,17651,163,17807,108,17963,18067,18171,18275,18379,18483,18587,18691
- };
- mavlink_manual_control_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.r = packet_in.r;
- packet1.buttons = packet_in.buttons;
- packet1.target = packet_in.target;
- packet1.buttons2 = packet_in.buttons2;
- packet1.enabled_extensions = packet_in.enabled_extensions;
- packet1.s = packet_in.s;
- packet1.t = packet_in.t;
- packet1.aux1 = packet_in.aux1;
- packet1.aux2 = packet_in.aux2;
- packet1.aux3 = packet_in.aux3;
- packet1.aux4 = packet_in.aux4;
- packet1.aux5 = packet_in.aux5;
- packet1.aux6 = packet_in.aux6;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MANUAL_CONTROL_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MANUAL_CONTROL_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_manual_control_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_manual_control_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_manual_control_pack(system_id, component_id, &msg , packet1.target , packet1.x , packet1.y , packet1.z , packet1.r , packet1.buttons , packet1.buttons2 , packet1.enabled_extensions , packet1.s , packet1.t , packet1.aux1 , packet1.aux2 , packet1.aux3 , packet1.aux4 , packet1.aux5 , packet1.aux6 );
- mavlink_msg_manual_control_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_manual_control_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target , packet1.x , packet1.y , packet1.z , packet1.r , packet1.buttons , packet1.buttons2 , packet1.enabled_extensions , packet1.s , packet1.t , packet1.aux1 , packet1.aux2 , packet1.aux3 , packet1.aux4 , packet1.aux5 , packet1.aux6 );
- mavlink_msg_manual_control_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_manual_control_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_manual_control_send(MAVLINK_COMM_1 , packet1.target , packet1.x , packet1.y , packet1.z , packet1.r , packet1.buttons , packet1.buttons2 , packet1.enabled_extensions , packet1.s , packet1.t , packet1.aux1 , packet1.aux2 , packet1.aux3 , packet1.aux4 , packet1.aux5 , packet1.aux6 );
- mavlink_msg_manual_control_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MANUAL_CONTROL") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MANUAL_CONTROL) != NULL);
- #endif
- }
- static void mavlink_test_rc_channels_override(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_RC_CHANNELS_OVERRIDE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_rc_channels_override_t packet_in = {
- 17235,17339,17443,17547,17651,17755,17859,17963,53,120,18171,18275,18379,18483,18587,18691,18795,18899,19003,19107
- };
- mavlink_rc_channels_override_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.chan1_raw = packet_in.chan1_raw;
- packet1.chan2_raw = packet_in.chan2_raw;
- packet1.chan3_raw = packet_in.chan3_raw;
- packet1.chan4_raw = packet_in.chan4_raw;
- packet1.chan5_raw = packet_in.chan5_raw;
- packet1.chan6_raw = packet_in.chan6_raw;
- packet1.chan7_raw = packet_in.chan7_raw;
- packet1.chan8_raw = packet_in.chan8_raw;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.chan9_raw = packet_in.chan9_raw;
- packet1.chan10_raw = packet_in.chan10_raw;
- packet1.chan11_raw = packet_in.chan11_raw;
- packet1.chan12_raw = packet_in.chan12_raw;
- packet1.chan13_raw = packet_in.chan13_raw;
- packet1.chan14_raw = packet_in.chan14_raw;
- packet1.chan15_raw = packet_in.chan15_raw;
- packet1.chan16_raw = packet_in.chan16_raw;
- packet1.chan17_raw = packet_in.chan17_raw;
- packet1.chan18_raw = packet_in.chan18_raw;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_RC_CHANNELS_OVERRIDE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_RC_CHANNELS_OVERRIDE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_rc_channels_override_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_rc_channels_override_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_rc_channels_override_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.chan1_raw , packet1.chan2_raw , packet1.chan3_raw , packet1.chan4_raw , packet1.chan5_raw , packet1.chan6_raw , packet1.chan7_raw , packet1.chan8_raw , packet1.chan9_raw , packet1.chan10_raw , packet1.chan11_raw , packet1.chan12_raw , packet1.chan13_raw , packet1.chan14_raw , packet1.chan15_raw , packet1.chan16_raw , packet1.chan17_raw , packet1.chan18_raw );
- mavlink_msg_rc_channels_override_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_rc_channels_override_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.chan1_raw , packet1.chan2_raw , packet1.chan3_raw , packet1.chan4_raw , packet1.chan5_raw , packet1.chan6_raw , packet1.chan7_raw , packet1.chan8_raw , packet1.chan9_raw , packet1.chan10_raw , packet1.chan11_raw , packet1.chan12_raw , packet1.chan13_raw , packet1.chan14_raw , packet1.chan15_raw , packet1.chan16_raw , packet1.chan17_raw , packet1.chan18_raw );
- mavlink_msg_rc_channels_override_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_rc_channels_override_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_rc_channels_override_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.chan1_raw , packet1.chan2_raw , packet1.chan3_raw , packet1.chan4_raw , packet1.chan5_raw , packet1.chan6_raw , packet1.chan7_raw , packet1.chan8_raw , packet1.chan9_raw , packet1.chan10_raw , packet1.chan11_raw , packet1.chan12_raw , packet1.chan13_raw , packet1.chan14_raw , packet1.chan15_raw , packet1.chan16_raw , packet1.chan17_raw , packet1.chan18_raw );
- mavlink_msg_rc_channels_override_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("RC_CHANNELS_OVERRIDE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_RC_CHANNELS_OVERRIDE) != NULL);
- #endif
- }
- static void mavlink_test_mission_item_int(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MISSION_ITEM_INT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_mission_item_int_t packet_in = {
- 17.0,45.0,73.0,101.0,963498296,963498504,185.0,18691,18795,101,168,235,46,113,180
- };
- mavlink_mission_item_int_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.param1 = packet_in.param1;
- packet1.param2 = packet_in.param2;
- packet1.param3 = packet_in.param3;
- packet1.param4 = packet_in.param4;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.seq = packet_in.seq;
- packet1.command = packet_in.command;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.frame = packet_in.frame;
- packet1.current = packet_in.current;
- packet1.autocontinue = packet_in.autocontinue;
- packet1.mission_type = packet_in.mission_type;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MISSION_ITEM_INT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MISSION_ITEM_INT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_item_int_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_mission_item_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_item_int_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.seq , packet1.frame , packet1.command , packet1.current , packet1.autocontinue , packet1.param1 , packet1.param2 , packet1.param3 , packet1.param4 , packet1.x , packet1.y , packet1.z , packet1.mission_type );
- mavlink_msg_mission_item_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_item_int_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.seq , packet1.frame , packet1.command , packet1.current , packet1.autocontinue , packet1.param1 , packet1.param2 , packet1.param3 , packet1.param4 , packet1.x , packet1.y , packet1.z , packet1.mission_type );
- mavlink_msg_mission_item_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_mission_item_int_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mission_item_int_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.seq , packet1.frame , packet1.command , packet1.current , packet1.autocontinue , packet1.param1 , packet1.param2 , packet1.param3 , packet1.param4 , packet1.x , packet1.y , packet1.z , packet1.mission_type );
- mavlink_msg_mission_item_int_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MISSION_ITEM_INT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MISSION_ITEM_INT) != NULL);
- #endif
- }
- static void mavlink_test_vfr_hud(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_VFR_HUD >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_vfr_hud_t packet_in = {
- 17.0,45.0,73.0,101.0,18067,18171
- };
- mavlink_vfr_hud_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.airspeed = packet_in.airspeed;
- packet1.groundspeed = packet_in.groundspeed;
- packet1.alt = packet_in.alt;
- packet1.climb = packet_in.climb;
- packet1.heading = packet_in.heading;
- packet1.throttle = packet_in.throttle;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_VFR_HUD_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_VFR_HUD_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vfr_hud_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_vfr_hud_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vfr_hud_pack(system_id, component_id, &msg , packet1.airspeed , packet1.groundspeed , packet1.heading , packet1.throttle , packet1.alt , packet1.climb );
- mavlink_msg_vfr_hud_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vfr_hud_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.airspeed , packet1.groundspeed , packet1.heading , packet1.throttle , packet1.alt , packet1.climb );
- mavlink_msg_vfr_hud_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_vfr_hud_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vfr_hud_send(MAVLINK_COMM_1 , packet1.airspeed , packet1.groundspeed , packet1.heading , packet1.throttle , packet1.alt , packet1.climb );
- mavlink_msg_vfr_hud_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("VFR_HUD") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_VFR_HUD) != NULL);
- #endif
- }
- static void mavlink_test_command_int(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_COMMAND_INT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_command_int_t packet_in = {
- 17.0,45.0,73.0,101.0,963498296,963498504,185.0,18691,223,34,101,168,235
- };
- mavlink_command_int_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.param1 = packet_in.param1;
- packet1.param2 = packet_in.param2;
- packet1.param3 = packet_in.param3;
- packet1.param4 = packet_in.param4;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.command = packet_in.command;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.frame = packet_in.frame;
- packet1.current = packet_in.current;
- packet1.autocontinue = packet_in.autocontinue;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_COMMAND_INT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_COMMAND_INT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_command_int_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_command_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_command_int_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.frame , packet1.command , packet1.current , packet1.autocontinue , packet1.param1 , packet1.param2 , packet1.param3 , packet1.param4 , packet1.x , packet1.y , packet1.z );
- mavlink_msg_command_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_command_int_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.frame , packet1.command , packet1.current , packet1.autocontinue , packet1.param1 , packet1.param2 , packet1.param3 , packet1.param4 , packet1.x , packet1.y , packet1.z );
- mavlink_msg_command_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_command_int_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_command_int_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.frame , packet1.command , packet1.current , packet1.autocontinue , packet1.param1 , packet1.param2 , packet1.param3 , packet1.param4 , packet1.x , packet1.y , packet1.z );
- mavlink_msg_command_int_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("COMMAND_INT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_COMMAND_INT) != NULL);
- #endif
- }
- static void mavlink_test_command_long(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_COMMAND_LONG >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_command_long_t packet_in = {
- 17.0,45.0,73.0,101.0,129.0,157.0,185.0,18691,223,34,101
- };
- mavlink_command_long_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.param1 = packet_in.param1;
- packet1.param2 = packet_in.param2;
- packet1.param3 = packet_in.param3;
- packet1.param4 = packet_in.param4;
- packet1.param5 = packet_in.param5;
- packet1.param6 = packet_in.param6;
- packet1.param7 = packet_in.param7;
- packet1.command = packet_in.command;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.confirmation = packet_in.confirmation;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_COMMAND_LONG_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_COMMAND_LONG_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_command_long_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_command_long_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_command_long_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.command , packet1.confirmation , packet1.param1 , packet1.param2 , packet1.param3 , packet1.param4 , packet1.param5 , packet1.param6 , packet1.param7 );
- mavlink_msg_command_long_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_command_long_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.command , packet1.confirmation , packet1.param1 , packet1.param2 , packet1.param3 , packet1.param4 , packet1.param5 , packet1.param6 , packet1.param7 );
- mavlink_msg_command_long_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_command_long_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_command_long_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.command , packet1.confirmation , packet1.param1 , packet1.param2 , packet1.param3 , packet1.param4 , packet1.param5 , packet1.param6 , packet1.param7 );
- mavlink_msg_command_long_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("COMMAND_LONG") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_COMMAND_LONG) != NULL);
- #endif
- }
- static void mavlink_test_command_ack(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_COMMAND_ACK >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_command_ack_t packet_in = {
- 17235,139,206,963497672,29,96
- };
- mavlink_command_ack_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.command = packet_in.command;
- packet1.result = packet_in.result;
- packet1.progress = packet_in.progress;
- packet1.result_param2 = packet_in.result_param2;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_COMMAND_ACK_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_COMMAND_ACK_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_command_ack_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_command_ack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_command_ack_pack(system_id, component_id, &msg , packet1.command , packet1.result , packet1.progress , packet1.result_param2 , packet1.target_system , packet1.target_component );
- mavlink_msg_command_ack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_command_ack_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.command , packet1.result , packet1.progress , packet1.result_param2 , packet1.target_system , packet1.target_component );
- mavlink_msg_command_ack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_command_ack_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_command_ack_send(MAVLINK_COMM_1 , packet1.command , packet1.result , packet1.progress , packet1.result_param2 , packet1.target_system , packet1.target_component );
- mavlink_msg_command_ack_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("COMMAND_ACK") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_COMMAND_ACK) != NULL);
- #endif
- }
- static void mavlink_test_command_cancel(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_COMMAND_CANCEL >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_command_cancel_t packet_in = {
- 17235,139,206
- };
- mavlink_command_cancel_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.command = packet_in.command;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_COMMAND_CANCEL_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_COMMAND_CANCEL_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_command_cancel_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_command_cancel_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_command_cancel_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.command );
- mavlink_msg_command_cancel_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_command_cancel_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.command );
- mavlink_msg_command_cancel_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_command_cancel_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_command_cancel_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.command );
- mavlink_msg_command_cancel_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("COMMAND_CANCEL") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_COMMAND_CANCEL) != NULL);
- #endif
- }
- static void mavlink_test_manual_setpoint(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MANUAL_SETPOINT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_manual_setpoint_t packet_in = {
- 963497464,45.0,73.0,101.0,129.0,65,132
- };
- mavlink_manual_setpoint_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.roll = packet_in.roll;
- packet1.pitch = packet_in.pitch;
- packet1.yaw = packet_in.yaw;
- packet1.thrust = packet_in.thrust;
- packet1.mode_switch = packet_in.mode_switch;
- packet1.manual_override_switch = packet_in.manual_override_switch;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MANUAL_SETPOINT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MANUAL_SETPOINT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_manual_setpoint_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_manual_setpoint_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_manual_setpoint_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.roll , packet1.pitch , packet1.yaw , packet1.thrust , packet1.mode_switch , packet1.manual_override_switch );
- mavlink_msg_manual_setpoint_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_manual_setpoint_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.roll , packet1.pitch , packet1.yaw , packet1.thrust , packet1.mode_switch , packet1.manual_override_switch );
- mavlink_msg_manual_setpoint_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_manual_setpoint_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_manual_setpoint_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.roll , packet1.pitch , packet1.yaw , packet1.thrust , packet1.mode_switch , packet1.manual_override_switch );
- mavlink_msg_manual_setpoint_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MANUAL_SETPOINT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MANUAL_SETPOINT) != NULL);
- #endif
- }
- static void mavlink_test_set_attitude_target(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SET_ATTITUDE_TARGET >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_set_attitude_target_t packet_in = {
- 963497464,{ 45.0, 46.0, 47.0, 48.0 },157.0,185.0,213.0,241.0,113,180,247,{ 290.0, 291.0, 292.0 }
- };
- mavlink_set_attitude_target_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.body_roll_rate = packet_in.body_roll_rate;
- packet1.body_pitch_rate = packet_in.body_pitch_rate;
- packet1.body_yaw_rate = packet_in.body_yaw_rate;
- packet1.thrust = packet_in.thrust;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.type_mask = packet_in.type_mask;
-
- mav_array_memcpy(packet1.q, packet_in.q, sizeof(float)*4);
- mav_array_memcpy(packet1.thrust_body, packet_in.thrust_body, sizeof(float)*3);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SET_ATTITUDE_TARGET_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SET_ATTITUDE_TARGET_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_attitude_target_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_set_attitude_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_attitude_target_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.target_system , packet1.target_component , packet1.type_mask , packet1.q , packet1.body_roll_rate , packet1.body_pitch_rate , packet1.body_yaw_rate , packet1.thrust , packet1.thrust_body );
- mavlink_msg_set_attitude_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_attitude_target_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.target_system , packet1.target_component , packet1.type_mask , packet1.q , packet1.body_roll_rate , packet1.body_pitch_rate , packet1.body_yaw_rate , packet1.thrust , packet1.thrust_body );
- mavlink_msg_set_attitude_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_set_attitude_target_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_attitude_target_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.target_system , packet1.target_component , packet1.type_mask , packet1.q , packet1.body_roll_rate , packet1.body_pitch_rate , packet1.body_yaw_rate , packet1.thrust , packet1.thrust_body );
- mavlink_msg_set_attitude_target_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SET_ATTITUDE_TARGET") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SET_ATTITUDE_TARGET) != NULL);
- #endif
- }
- static void mavlink_test_attitude_target(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ATTITUDE_TARGET >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_attitude_target_t packet_in = {
- 963497464,{ 45.0, 46.0, 47.0, 48.0 },157.0,185.0,213.0,241.0,113
- };
- mavlink_attitude_target_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.body_roll_rate = packet_in.body_roll_rate;
- packet1.body_pitch_rate = packet_in.body_pitch_rate;
- packet1.body_yaw_rate = packet_in.body_yaw_rate;
- packet1.thrust = packet_in.thrust;
- packet1.type_mask = packet_in.type_mask;
-
- mav_array_memcpy(packet1.q, packet_in.q, sizeof(float)*4);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ATTITUDE_TARGET_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ATTITUDE_TARGET_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_attitude_target_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_attitude_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_attitude_target_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.type_mask , packet1.q , packet1.body_roll_rate , packet1.body_pitch_rate , packet1.body_yaw_rate , packet1.thrust );
- mavlink_msg_attitude_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_attitude_target_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.type_mask , packet1.q , packet1.body_roll_rate , packet1.body_pitch_rate , packet1.body_yaw_rate , packet1.thrust );
- mavlink_msg_attitude_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_attitude_target_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_attitude_target_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.type_mask , packet1.q , packet1.body_roll_rate , packet1.body_pitch_rate , packet1.body_yaw_rate , packet1.thrust );
- mavlink_msg_attitude_target_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ATTITUDE_TARGET") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ATTITUDE_TARGET) != NULL);
- #endif
- }
- static void mavlink_test_set_position_target_local_ned(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SET_POSITION_TARGET_LOCAL_NED >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_set_position_target_local_ned_t packet_in = {
- 963497464,45.0,73.0,101.0,129.0,157.0,185.0,213.0,241.0,269.0,297.0,325.0,19731,27,94,161
- };
- mavlink_set_position_target_local_ned_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.vx = packet_in.vx;
- packet1.vy = packet_in.vy;
- packet1.vz = packet_in.vz;
- packet1.afx = packet_in.afx;
- packet1.afy = packet_in.afy;
- packet1.afz = packet_in.afz;
- packet1.yaw = packet_in.yaw;
- packet1.yaw_rate = packet_in.yaw_rate;
- packet1.type_mask = packet_in.type_mask;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.coordinate_frame = packet_in.coordinate_frame;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SET_POSITION_TARGET_LOCAL_NED_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SET_POSITION_TARGET_LOCAL_NED_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_position_target_local_ned_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_set_position_target_local_ned_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_position_target_local_ned_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.target_system , packet1.target_component , packet1.coordinate_frame , packet1.type_mask , packet1.x , packet1.y , packet1.z , packet1.vx , packet1.vy , packet1.vz , packet1.afx , packet1.afy , packet1.afz , packet1.yaw , packet1.yaw_rate );
- mavlink_msg_set_position_target_local_ned_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_position_target_local_ned_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.target_system , packet1.target_component , packet1.coordinate_frame , packet1.type_mask , packet1.x , packet1.y , packet1.z , packet1.vx , packet1.vy , packet1.vz , packet1.afx , packet1.afy , packet1.afz , packet1.yaw , packet1.yaw_rate );
- mavlink_msg_set_position_target_local_ned_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_set_position_target_local_ned_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_position_target_local_ned_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.target_system , packet1.target_component , packet1.coordinate_frame , packet1.type_mask , packet1.x , packet1.y , packet1.z , packet1.vx , packet1.vy , packet1.vz , packet1.afx , packet1.afy , packet1.afz , packet1.yaw , packet1.yaw_rate );
- mavlink_msg_set_position_target_local_ned_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SET_POSITION_TARGET_LOCAL_NED") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SET_POSITION_TARGET_LOCAL_NED) != NULL);
- #endif
- }
- static void mavlink_test_position_target_local_ned(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_POSITION_TARGET_LOCAL_NED >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_position_target_local_ned_t packet_in = {
- 963497464,45.0,73.0,101.0,129.0,157.0,185.0,213.0,241.0,269.0,297.0,325.0,19731,27
- };
- mavlink_position_target_local_ned_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.vx = packet_in.vx;
- packet1.vy = packet_in.vy;
- packet1.vz = packet_in.vz;
- packet1.afx = packet_in.afx;
- packet1.afy = packet_in.afy;
- packet1.afz = packet_in.afz;
- packet1.yaw = packet_in.yaw;
- packet1.yaw_rate = packet_in.yaw_rate;
- packet1.type_mask = packet_in.type_mask;
- packet1.coordinate_frame = packet_in.coordinate_frame;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_POSITION_TARGET_LOCAL_NED_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_POSITION_TARGET_LOCAL_NED_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_position_target_local_ned_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_position_target_local_ned_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_position_target_local_ned_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.coordinate_frame , packet1.type_mask , packet1.x , packet1.y , packet1.z , packet1.vx , packet1.vy , packet1.vz , packet1.afx , packet1.afy , packet1.afz , packet1.yaw , packet1.yaw_rate );
- mavlink_msg_position_target_local_ned_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_position_target_local_ned_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.coordinate_frame , packet1.type_mask , packet1.x , packet1.y , packet1.z , packet1.vx , packet1.vy , packet1.vz , packet1.afx , packet1.afy , packet1.afz , packet1.yaw , packet1.yaw_rate );
- mavlink_msg_position_target_local_ned_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_position_target_local_ned_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_position_target_local_ned_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.coordinate_frame , packet1.type_mask , packet1.x , packet1.y , packet1.z , packet1.vx , packet1.vy , packet1.vz , packet1.afx , packet1.afy , packet1.afz , packet1.yaw , packet1.yaw_rate );
- mavlink_msg_position_target_local_ned_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("POSITION_TARGET_LOCAL_NED") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_POSITION_TARGET_LOCAL_NED) != NULL);
- #endif
- }
- static void mavlink_test_set_position_target_global_int(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SET_POSITION_TARGET_GLOBAL_INT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_set_position_target_global_int_t packet_in = {
- 963497464,963497672,963497880,101.0,129.0,157.0,185.0,213.0,241.0,269.0,297.0,325.0,19731,27,94,161
- };
- mavlink_set_position_target_global_int_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.lat_int = packet_in.lat_int;
- packet1.lon_int = packet_in.lon_int;
- packet1.alt = packet_in.alt;
- packet1.vx = packet_in.vx;
- packet1.vy = packet_in.vy;
- packet1.vz = packet_in.vz;
- packet1.afx = packet_in.afx;
- packet1.afy = packet_in.afy;
- packet1.afz = packet_in.afz;
- packet1.yaw = packet_in.yaw;
- packet1.yaw_rate = packet_in.yaw_rate;
- packet1.type_mask = packet_in.type_mask;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.coordinate_frame = packet_in.coordinate_frame;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SET_POSITION_TARGET_GLOBAL_INT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SET_POSITION_TARGET_GLOBAL_INT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_position_target_global_int_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_set_position_target_global_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_position_target_global_int_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.target_system , packet1.target_component , packet1.coordinate_frame , packet1.type_mask , packet1.lat_int , packet1.lon_int , packet1.alt , packet1.vx , packet1.vy , packet1.vz , packet1.afx , packet1.afy , packet1.afz , packet1.yaw , packet1.yaw_rate );
- mavlink_msg_set_position_target_global_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_position_target_global_int_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.target_system , packet1.target_component , packet1.coordinate_frame , packet1.type_mask , packet1.lat_int , packet1.lon_int , packet1.alt , packet1.vx , packet1.vy , packet1.vz , packet1.afx , packet1.afy , packet1.afz , packet1.yaw , packet1.yaw_rate );
- mavlink_msg_set_position_target_global_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_set_position_target_global_int_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_position_target_global_int_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.target_system , packet1.target_component , packet1.coordinate_frame , packet1.type_mask , packet1.lat_int , packet1.lon_int , packet1.alt , packet1.vx , packet1.vy , packet1.vz , packet1.afx , packet1.afy , packet1.afz , packet1.yaw , packet1.yaw_rate );
- mavlink_msg_set_position_target_global_int_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SET_POSITION_TARGET_GLOBAL_INT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SET_POSITION_TARGET_GLOBAL_INT) != NULL);
- #endif
- }
- static void mavlink_test_position_target_global_int(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_POSITION_TARGET_GLOBAL_INT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_position_target_global_int_t packet_in = {
- 963497464,963497672,963497880,101.0,129.0,157.0,185.0,213.0,241.0,269.0,297.0,325.0,19731,27
- };
- mavlink_position_target_global_int_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.lat_int = packet_in.lat_int;
- packet1.lon_int = packet_in.lon_int;
- packet1.alt = packet_in.alt;
- packet1.vx = packet_in.vx;
- packet1.vy = packet_in.vy;
- packet1.vz = packet_in.vz;
- packet1.afx = packet_in.afx;
- packet1.afy = packet_in.afy;
- packet1.afz = packet_in.afz;
- packet1.yaw = packet_in.yaw;
- packet1.yaw_rate = packet_in.yaw_rate;
- packet1.type_mask = packet_in.type_mask;
- packet1.coordinate_frame = packet_in.coordinate_frame;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_POSITION_TARGET_GLOBAL_INT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_POSITION_TARGET_GLOBAL_INT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_position_target_global_int_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_position_target_global_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_position_target_global_int_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.coordinate_frame , packet1.type_mask , packet1.lat_int , packet1.lon_int , packet1.alt , packet1.vx , packet1.vy , packet1.vz , packet1.afx , packet1.afy , packet1.afz , packet1.yaw , packet1.yaw_rate );
- mavlink_msg_position_target_global_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_position_target_global_int_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.coordinate_frame , packet1.type_mask , packet1.lat_int , packet1.lon_int , packet1.alt , packet1.vx , packet1.vy , packet1.vz , packet1.afx , packet1.afy , packet1.afz , packet1.yaw , packet1.yaw_rate );
- mavlink_msg_position_target_global_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_position_target_global_int_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_position_target_global_int_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.coordinate_frame , packet1.type_mask , packet1.lat_int , packet1.lon_int , packet1.alt , packet1.vx , packet1.vy , packet1.vz , packet1.afx , packet1.afy , packet1.afz , packet1.yaw , packet1.yaw_rate );
- mavlink_msg_position_target_global_int_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("POSITION_TARGET_GLOBAL_INT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_POSITION_TARGET_GLOBAL_INT) != NULL);
- #endif
- }
- static void mavlink_test_local_position_ned_system_global_offset(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_LOCAL_POSITION_NED_SYSTEM_GLOBAL_OFFSET >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_local_position_ned_system_global_offset_t packet_in = {
- 963497464,45.0,73.0,101.0,129.0,157.0,185.0
- };
- mavlink_local_position_ned_system_global_offset_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.roll = packet_in.roll;
- packet1.pitch = packet_in.pitch;
- packet1.yaw = packet_in.yaw;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_LOCAL_POSITION_NED_SYSTEM_GLOBAL_OFFSET_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_LOCAL_POSITION_NED_SYSTEM_GLOBAL_OFFSET_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_local_position_ned_system_global_offset_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_local_position_ned_system_global_offset_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_local_position_ned_system_global_offset_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.x , packet1.y , packet1.z , packet1.roll , packet1.pitch , packet1.yaw );
- mavlink_msg_local_position_ned_system_global_offset_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_local_position_ned_system_global_offset_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.x , packet1.y , packet1.z , packet1.roll , packet1.pitch , packet1.yaw );
- mavlink_msg_local_position_ned_system_global_offset_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_local_position_ned_system_global_offset_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_local_position_ned_system_global_offset_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.x , packet1.y , packet1.z , packet1.roll , packet1.pitch , packet1.yaw );
- mavlink_msg_local_position_ned_system_global_offset_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("LOCAL_POSITION_NED_SYSTEM_GLOBAL_OFFSET") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_LOCAL_POSITION_NED_SYSTEM_GLOBAL_OFFSET) != NULL);
- #endif
- }
- static void mavlink_test_hil_state(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_HIL_STATE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_hil_state_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,157.0,185.0,213.0,963499128,963499336,963499544,19523,19627,19731,19835,19939,20043
- };
- mavlink_hil_state_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.roll = packet_in.roll;
- packet1.pitch = packet_in.pitch;
- packet1.yaw = packet_in.yaw;
- packet1.rollspeed = packet_in.rollspeed;
- packet1.pitchspeed = packet_in.pitchspeed;
- packet1.yawspeed = packet_in.yawspeed;
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.alt = packet_in.alt;
- packet1.vx = packet_in.vx;
- packet1.vy = packet_in.vy;
- packet1.vz = packet_in.vz;
- packet1.xacc = packet_in.xacc;
- packet1.yacc = packet_in.yacc;
- packet1.zacc = packet_in.zacc;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_HIL_STATE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_HIL_STATE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_state_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_hil_state_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_state_pack(system_id, component_id, &msg , packet1.time_usec , packet1.roll , packet1.pitch , packet1.yaw , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed , packet1.lat , packet1.lon , packet1.alt , packet1.vx , packet1.vy , packet1.vz , packet1.xacc , packet1.yacc , packet1.zacc );
- mavlink_msg_hil_state_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_state_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.roll , packet1.pitch , packet1.yaw , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed , packet1.lat , packet1.lon , packet1.alt , packet1.vx , packet1.vy , packet1.vz , packet1.xacc , packet1.yacc , packet1.zacc );
- mavlink_msg_hil_state_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_hil_state_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_state_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.roll , packet1.pitch , packet1.yaw , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed , packet1.lat , packet1.lon , packet1.alt , packet1.vx , packet1.vy , packet1.vz , packet1.xacc , packet1.yacc , packet1.zacc );
- mavlink_msg_hil_state_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("HIL_STATE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_HIL_STATE) != NULL);
- #endif
- }
- static void mavlink_test_hil_controls(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_HIL_CONTROLS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_hil_controls_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,157.0,185.0,213.0,241.0,269.0,125,192
- };
- mavlink_hil_controls_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.roll_ailerons = packet_in.roll_ailerons;
- packet1.pitch_elevator = packet_in.pitch_elevator;
- packet1.yaw_rudder = packet_in.yaw_rudder;
- packet1.throttle = packet_in.throttle;
- packet1.aux1 = packet_in.aux1;
- packet1.aux2 = packet_in.aux2;
- packet1.aux3 = packet_in.aux3;
- packet1.aux4 = packet_in.aux4;
- packet1.mode = packet_in.mode;
- packet1.nav_mode = packet_in.nav_mode;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_HIL_CONTROLS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_HIL_CONTROLS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_controls_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_hil_controls_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_controls_pack(system_id, component_id, &msg , packet1.time_usec , packet1.roll_ailerons , packet1.pitch_elevator , packet1.yaw_rudder , packet1.throttle , packet1.aux1 , packet1.aux2 , packet1.aux3 , packet1.aux4 , packet1.mode , packet1.nav_mode );
- mavlink_msg_hil_controls_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_controls_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.roll_ailerons , packet1.pitch_elevator , packet1.yaw_rudder , packet1.throttle , packet1.aux1 , packet1.aux2 , packet1.aux3 , packet1.aux4 , packet1.mode , packet1.nav_mode );
- mavlink_msg_hil_controls_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_hil_controls_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_controls_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.roll_ailerons , packet1.pitch_elevator , packet1.yaw_rudder , packet1.throttle , packet1.aux1 , packet1.aux2 , packet1.aux3 , packet1.aux4 , packet1.mode , packet1.nav_mode );
- mavlink_msg_hil_controls_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("HIL_CONTROLS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_HIL_CONTROLS) != NULL);
- #endif
- }
- static void mavlink_test_hil_rc_inputs_raw(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_HIL_RC_INPUTS_RAW >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_hil_rc_inputs_raw_t packet_in = {
- 93372036854775807ULL,17651,17755,17859,17963,18067,18171,18275,18379,18483,18587,18691,18795,101
- };
- mavlink_hil_rc_inputs_raw_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.chan1_raw = packet_in.chan1_raw;
- packet1.chan2_raw = packet_in.chan2_raw;
- packet1.chan3_raw = packet_in.chan3_raw;
- packet1.chan4_raw = packet_in.chan4_raw;
- packet1.chan5_raw = packet_in.chan5_raw;
- packet1.chan6_raw = packet_in.chan6_raw;
- packet1.chan7_raw = packet_in.chan7_raw;
- packet1.chan8_raw = packet_in.chan8_raw;
- packet1.chan9_raw = packet_in.chan9_raw;
- packet1.chan10_raw = packet_in.chan10_raw;
- packet1.chan11_raw = packet_in.chan11_raw;
- packet1.chan12_raw = packet_in.chan12_raw;
- packet1.rssi = packet_in.rssi;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_HIL_RC_INPUTS_RAW_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_HIL_RC_INPUTS_RAW_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_rc_inputs_raw_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_hil_rc_inputs_raw_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_rc_inputs_raw_pack(system_id, component_id, &msg , packet1.time_usec , packet1.chan1_raw , packet1.chan2_raw , packet1.chan3_raw , packet1.chan4_raw , packet1.chan5_raw , packet1.chan6_raw , packet1.chan7_raw , packet1.chan8_raw , packet1.chan9_raw , packet1.chan10_raw , packet1.chan11_raw , packet1.chan12_raw , packet1.rssi );
- mavlink_msg_hil_rc_inputs_raw_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_rc_inputs_raw_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.chan1_raw , packet1.chan2_raw , packet1.chan3_raw , packet1.chan4_raw , packet1.chan5_raw , packet1.chan6_raw , packet1.chan7_raw , packet1.chan8_raw , packet1.chan9_raw , packet1.chan10_raw , packet1.chan11_raw , packet1.chan12_raw , packet1.rssi );
- mavlink_msg_hil_rc_inputs_raw_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_hil_rc_inputs_raw_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_rc_inputs_raw_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.chan1_raw , packet1.chan2_raw , packet1.chan3_raw , packet1.chan4_raw , packet1.chan5_raw , packet1.chan6_raw , packet1.chan7_raw , packet1.chan8_raw , packet1.chan9_raw , packet1.chan10_raw , packet1.chan11_raw , packet1.chan12_raw , packet1.rssi );
- mavlink_msg_hil_rc_inputs_raw_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("HIL_RC_INPUTS_RAW") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_HIL_RC_INPUTS_RAW) != NULL);
- #endif
- }
- static void mavlink_test_hil_actuator_controls(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_HIL_ACTUATOR_CONTROLS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_hil_actuator_controls_t packet_in = {
- 93372036854775807ULL,93372036854776311ULL,{ 129.0, 130.0, 131.0, 132.0, 133.0, 134.0, 135.0, 136.0, 137.0, 138.0, 139.0, 140.0, 141.0, 142.0, 143.0, 144.0 },245
- };
- mavlink_hil_actuator_controls_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.flags = packet_in.flags;
- packet1.mode = packet_in.mode;
-
- mav_array_memcpy(packet1.controls, packet_in.controls, sizeof(float)*16);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_HIL_ACTUATOR_CONTROLS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_HIL_ACTUATOR_CONTROLS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_actuator_controls_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_hil_actuator_controls_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_actuator_controls_pack(system_id, component_id, &msg , packet1.time_usec , packet1.controls , packet1.mode , packet1.flags );
- mavlink_msg_hil_actuator_controls_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_actuator_controls_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.controls , packet1.mode , packet1.flags );
- mavlink_msg_hil_actuator_controls_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_hil_actuator_controls_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_actuator_controls_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.controls , packet1.mode , packet1.flags );
- mavlink_msg_hil_actuator_controls_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("HIL_ACTUATOR_CONTROLS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_HIL_ACTUATOR_CONTROLS) != NULL);
- #endif
- }
- static void mavlink_test_optical_flow(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_OPTICAL_FLOW >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_optical_flow_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,18275,18379,77,144,199.0,227.0
- };
- mavlink_optical_flow_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.flow_comp_m_x = packet_in.flow_comp_m_x;
- packet1.flow_comp_m_y = packet_in.flow_comp_m_y;
- packet1.ground_distance = packet_in.ground_distance;
- packet1.flow_x = packet_in.flow_x;
- packet1.flow_y = packet_in.flow_y;
- packet1.sensor_id = packet_in.sensor_id;
- packet1.quality = packet_in.quality;
- packet1.flow_rate_x = packet_in.flow_rate_x;
- packet1.flow_rate_y = packet_in.flow_rate_y;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_OPTICAL_FLOW_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_OPTICAL_FLOW_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_optical_flow_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_optical_flow_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_optical_flow_pack(system_id, component_id, &msg , packet1.time_usec , packet1.sensor_id , packet1.flow_x , packet1.flow_y , packet1.flow_comp_m_x , packet1.flow_comp_m_y , packet1.quality , packet1.ground_distance , packet1.flow_rate_x , packet1.flow_rate_y );
- mavlink_msg_optical_flow_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_optical_flow_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.sensor_id , packet1.flow_x , packet1.flow_y , packet1.flow_comp_m_x , packet1.flow_comp_m_y , packet1.quality , packet1.ground_distance , packet1.flow_rate_x , packet1.flow_rate_y );
- mavlink_msg_optical_flow_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_optical_flow_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_optical_flow_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.sensor_id , packet1.flow_x , packet1.flow_y , packet1.flow_comp_m_x , packet1.flow_comp_m_y , packet1.quality , packet1.ground_distance , packet1.flow_rate_x , packet1.flow_rate_y );
- mavlink_msg_optical_flow_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("OPTICAL_FLOW") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_OPTICAL_FLOW) != NULL);
- #endif
- }
- static void mavlink_test_global_vision_position_estimate(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GLOBAL_VISION_POSITION_ESTIMATE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_global_vision_position_estimate_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,157.0,185.0,213.0,{ 241.0, 242.0, 243.0, 244.0, 245.0, 246.0, 247.0, 248.0, 249.0, 250.0, 251.0, 252.0, 253.0, 254.0, 255.0, 256.0, 257.0, 258.0, 259.0, 260.0, 261.0 },97
- };
- mavlink_global_vision_position_estimate_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.usec = packet_in.usec;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.roll = packet_in.roll;
- packet1.pitch = packet_in.pitch;
- packet1.yaw = packet_in.yaw;
- packet1.reset_counter = packet_in.reset_counter;
-
- mav_array_memcpy(packet1.covariance, packet_in.covariance, sizeof(float)*21);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GLOBAL_VISION_POSITION_ESTIMATE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GLOBAL_VISION_POSITION_ESTIMATE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_global_vision_position_estimate_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_global_vision_position_estimate_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_global_vision_position_estimate_pack(system_id, component_id, &msg , packet1.usec , packet1.x , packet1.y , packet1.z , packet1.roll , packet1.pitch , packet1.yaw , packet1.covariance , packet1.reset_counter );
- mavlink_msg_global_vision_position_estimate_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_global_vision_position_estimate_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.usec , packet1.x , packet1.y , packet1.z , packet1.roll , packet1.pitch , packet1.yaw , packet1.covariance , packet1.reset_counter );
- mavlink_msg_global_vision_position_estimate_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_global_vision_position_estimate_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_global_vision_position_estimate_send(MAVLINK_COMM_1 , packet1.usec , packet1.x , packet1.y , packet1.z , packet1.roll , packet1.pitch , packet1.yaw , packet1.covariance , packet1.reset_counter );
- mavlink_msg_global_vision_position_estimate_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GLOBAL_VISION_POSITION_ESTIMATE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GLOBAL_VISION_POSITION_ESTIMATE) != NULL);
- #endif
- }
- static void mavlink_test_vision_position_estimate(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_VISION_POSITION_ESTIMATE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_vision_position_estimate_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,157.0,185.0,213.0,{ 241.0, 242.0, 243.0, 244.0, 245.0, 246.0, 247.0, 248.0, 249.0, 250.0, 251.0, 252.0, 253.0, 254.0, 255.0, 256.0, 257.0, 258.0, 259.0, 260.0, 261.0 },97
- };
- mavlink_vision_position_estimate_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.usec = packet_in.usec;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.roll = packet_in.roll;
- packet1.pitch = packet_in.pitch;
- packet1.yaw = packet_in.yaw;
- packet1.reset_counter = packet_in.reset_counter;
-
- mav_array_memcpy(packet1.covariance, packet_in.covariance, sizeof(float)*21);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_VISION_POSITION_ESTIMATE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_VISION_POSITION_ESTIMATE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vision_position_estimate_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_vision_position_estimate_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vision_position_estimate_pack(system_id, component_id, &msg , packet1.usec , packet1.x , packet1.y , packet1.z , packet1.roll , packet1.pitch , packet1.yaw , packet1.covariance , packet1.reset_counter );
- mavlink_msg_vision_position_estimate_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vision_position_estimate_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.usec , packet1.x , packet1.y , packet1.z , packet1.roll , packet1.pitch , packet1.yaw , packet1.covariance , packet1.reset_counter );
- mavlink_msg_vision_position_estimate_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_vision_position_estimate_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vision_position_estimate_send(MAVLINK_COMM_1 , packet1.usec , packet1.x , packet1.y , packet1.z , packet1.roll , packet1.pitch , packet1.yaw , packet1.covariance , packet1.reset_counter );
- mavlink_msg_vision_position_estimate_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("VISION_POSITION_ESTIMATE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_VISION_POSITION_ESTIMATE) != NULL);
- #endif
- }
- static void mavlink_test_vision_speed_estimate(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_VISION_SPEED_ESTIMATE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_vision_speed_estimate_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,{ 157.0, 158.0, 159.0, 160.0, 161.0, 162.0, 163.0, 164.0, 165.0 },173
- };
- mavlink_vision_speed_estimate_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.usec = packet_in.usec;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.reset_counter = packet_in.reset_counter;
-
- mav_array_memcpy(packet1.covariance, packet_in.covariance, sizeof(float)*9);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_VISION_SPEED_ESTIMATE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_VISION_SPEED_ESTIMATE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vision_speed_estimate_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_vision_speed_estimate_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vision_speed_estimate_pack(system_id, component_id, &msg , packet1.usec , packet1.x , packet1.y , packet1.z , packet1.covariance , packet1.reset_counter );
- mavlink_msg_vision_speed_estimate_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vision_speed_estimate_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.usec , packet1.x , packet1.y , packet1.z , packet1.covariance , packet1.reset_counter );
- mavlink_msg_vision_speed_estimate_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_vision_speed_estimate_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vision_speed_estimate_send(MAVLINK_COMM_1 , packet1.usec , packet1.x , packet1.y , packet1.z , packet1.covariance , packet1.reset_counter );
- mavlink_msg_vision_speed_estimate_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("VISION_SPEED_ESTIMATE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_VISION_SPEED_ESTIMATE) != NULL);
- #endif
- }
- static void mavlink_test_vicon_position_estimate(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_vicon_position_estimate_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,157.0,185.0,213.0,{ 241.0, 242.0, 243.0, 244.0, 245.0, 246.0, 247.0, 248.0, 249.0, 250.0, 251.0, 252.0, 253.0, 254.0, 255.0, 256.0, 257.0, 258.0, 259.0, 260.0, 261.0 }
- };
- mavlink_vicon_position_estimate_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.usec = packet_in.usec;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.roll = packet_in.roll;
- packet1.pitch = packet_in.pitch;
- packet1.yaw = packet_in.yaw;
-
- mav_array_memcpy(packet1.covariance, packet_in.covariance, sizeof(float)*21);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vicon_position_estimate_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_vicon_position_estimate_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vicon_position_estimate_pack(system_id, component_id, &msg , packet1.usec , packet1.x , packet1.y , packet1.z , packet1.roll , packet1.pitch , packet1.yaw , packet1.covariance );
- mavlink_msg_vicon_position_estimate_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vicon_position_estimate_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.usec , packet1.x , packet1.y , packet1.z , packet1.roll , packet1.pitch , packet1.yaw , packet1.covariance );
- mavlink_msg_vicon_position_estimate_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_vicon_position_estimate_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vicon_position_estimate_send(MAVLINK_COMM_1 , packet1.usec , packet1.x , packet1.y , packet1.z , packet1.roll , packet1.pitch , packet1.yaw , packet1.covariance );
- mavlink_msg_vicon_position_estimate_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("VICON_POSITION_ESTIMATE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_VICON_POSITION_ESTIMATE) != NULL);
- #endif
- }
- static void mavlink_test_highres_imu(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_HIGHRES_IMU >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_highres_imu_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,157.0,185.0,213.0,241.0,269.0,297.0,325.0,353.0,381.0,409.0,20355,63
- };
- mavlink_highres_imu_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.xacc = packet_in.xacc;
- packet1.yacc = packet_in.yacc;
- packet1.zacc = packet_in.zacc;
- packet1.xgyro = packet_in.xgyro;
- packet1.ygyro = packet_in.ygyro;
- packet1.zgyro = packet_in.zgyro;
- packet1.xmag = packet_in.xmag;
- packet1.ymag = packet_in.ymag;
- packet1.zmag = packet_in.zmag;
- packet1.abs_pressure = packet_in.abs_pressure;
- packet1.diff_pressure = packet_in.diff_pressure;
- packet1.pressure_alt = packet_in.pressure_alt;
- packet1.temperature = packet_in.temperature;
- packet1.fields_updated = packet_in.fields_updated;
- packet1.id = packet_in.id;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_HIGHRES_IMU_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_HIGHRES_IMU_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_highres_imu_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_highres_imu_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_highres_imu_pack(system_id, component_id, &msg , packet1.time_usec , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.abs_pressure , packet1.diff_pressure , packet1.pressure_alt , packet1.temperature , packet1.fields_updated , packet1.id );
- mavlink_msg_highres_imu_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_highres_imu_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.abs_pressure , packet1.diff_pressure , packet1.pressure_alt , packet1.temperature , packet1.fields_updated , packet1.id );
- mavlink_msg_highres_imu_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_highres_imu_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_highres_imu_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.abs_pressure , packet1.diff_pressure , packet1.pressure_alt , packet1.temperature , packet1.fields_updated , packet1.id );
- mavlink_msg_highres_imu_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("HIGHRES_IMU") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_HIGHRES_IMU) != NULL);
- #endif
- }
- static void mavlink_test_optical_flow_rad(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_OPTICAL_FLOW_RAD >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_optical_flow_rad_t packet_in = {
- 93372036854775807ULL,963497880,101.0,129.0,157.0,185.0,213.0,963499128,269.0,19315,3,70
- };
- mavlink_optical_flow_rad_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.integration_time_us = packet_in.integration_time_us;
- packet1.integrated_x = packet_in.integrated_x;
- packet1.integrated_y = packet_in.integrated_y;
- packet1.integrated_xgyro = packet_in.integrated_xgyro;
- packet1.integrated_ygyro = packet_in.integrated_ygyro;
- packet1.integrated_zgyro = packet_in.integrated_zgyro;
- packet1.time_delta_distance_us = packet_in.time_delta_distance_us;
- packet1.distance = packet_in.distance;
- packet1.temperature = packet_in.temperature;
- packet1.sensor_id = packet_in.sensor_id;
- packet1.quality = packet_in.quality;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_OPTICAL_FLOW_RAD_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_OPTICAL_FLOW_RAD_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_optical_flow_rad_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_optical_flow_rad_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_optical_flow_rad_pack(system_id, component_id, &msg , packet1.time_usec , packet1.sensor_id , packet1.integration_time_us , packet1.integrated_x , packet1.integrated_y , packet1.integrated_xgyro , packet1.integrated_ygyro , packet1.integrated_zgyro , packet1.temperature , packet1.quality , packet1.time_delta_distance_us , packet1.distance );
- mavlink_msg_optical_flow_rad_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_optical_flow_rad_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.sensor_id , packet1.integration_time_us , packet1.integrated_x , packet1.integrated_y , packet1.integrated_xgyro , packet1.integrated_ygyro , packet1.integrated_zgyro , packet1.temperature , packet1.quality , packet1.time_delta_distance_us , packet1.distance );
- mavlink_msg_optical_flow_rad_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_optical_flow_rad_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_optical_flow_rad_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.sensor_id , packet1.integration_time_us , packet1.integrated_x , packet1.integrated_y , packet1.integrated_xgyro , packet1.integrated_ygyro , packet1.integrated_zgyro , packet1.temperature , packet1.quality , packet1.time_delta_distance_us , packet1.distance );
- mavlink_msg_optical_flow_rad_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("OPTICAL_FLOW_RAD") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_OPTICAL_FLOW_RAD) != NULL);
- #endif
- }
- static void mavlink_test_hil_sensor(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_HIL_SENSOR >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_hil_sensor_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,157.0,185.0,213.0,241.0,269.0,297.0,325.0,353.0,381.0,409.0,963500584,197
- };
- mavlink_hil_sensor_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.xacc = packet_in.xacc;
- packet1.yacc = packet_in.yacc;
- packet1.zacc = packet_in.zacc;
- packet1.xgyro = packet_in.xgyro;
- packet1.ygyro = packet_in.ygyro;
- packet1.zgyro = packet_in.zgyro;
- packet1.xmag = packet_in.xmag;
- packet1.ymag = packet_in.ymag;
- packet1.zmag = packet_in.zmag;
- packet1.abs_pressure = packet_in.abs_pressure;
- packet1.diff_pressure = packet_in.diff_pressure;
- packet1.pressure_alt = packet_in.pressure_alt;
- packet1.temperature = packet_in.temperature;
- packet1.fields_updated = packet_in.fields_updated;
- packet1.id = packet_in.id;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_HIL_SENSOR_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_HIL_SENSOR_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_sensor_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_hil_sensor_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_sensor_pack(system_id, component_id, &msg , packet1.time_usec , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.abs_pressure , packet1.diff_pressure , packet1.pressure_alt , packet1.temperature , packet1.fields_updated , packet1.id );
- mavlink_msg_hil_sensor_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_sensor_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.abs_pressure , packet1.diff_pressure , packet1.pressure_alt , packet1.temperature , packet1.fields_updated , packet1.id );
- mavlink_msg_hil_sensor_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_hil_sensor_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_sensor_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.abs_pressure , packet1.diff_pressure , packet1.pressure_alt , packet1.temperature , packet1.fields_updated , packet1.id );
- mavlink_msg_hil_sensor_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("HIL_SENSOR") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_HIL_SENSOR) != NULL);
- #endif
- }
- static void mavlink_test_sim_state(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SIM_STATE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_sim_state_t packet_in = {
- 17.0,45.0,73.0,101.0,129.0,157.0,185.0,213.0,241.0,269.0,297.0,325.0,353.0,381.0,409.0,437.0,465.0,493.0,521.0,549.0,577.0,963501832,963502040
- };
- mavlink_sim_state_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.q1 = packet_in.q1;
- packet1.q2 = packet_in.q2;
- packet1.q3 = packet_in.q3;
- packet1.q4 = packet_in.q4;
- packet1.roll = packet_in.roll;
- packet1.pitch = packet_in.pitch;
- packet1.yaw = packet_in.yaw;
- packet1.xacc = packet_in.xacc;
- packet1.yacc = packet_in.yacc;
- packet1.zacc = packet_in.zacc;
- packet1.xgyro = packet_in.xgyro;
- packet1.ygyro = packet_in.ygyro;
- packet1.zgyro = packet_in.zgyro;
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.alt = packet_in.alt;
- packet1.std_dev_horz = packet_in.std_dev_horz;
- packet1.std_dev_vert = packet_in.std_dev_vert;
- packet1.vn = packet_in.vn;
- packet1.ve = packet_in.ve;
- packet1.vd = packet_in.vd;
- packet1.lat_int = packet_in.lat_int;
- packet1.lon_int = packet_in.lon_int;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SIM_STATE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SIM_STATE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_sim_state_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_sim_state_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_sim_state_pack(system_id, component_id, &msg , packet1.q1 , packet1.q2 , packet1.q3 , packet1.q4 , packet1.roll , packet1.pitch , packet1.yaw , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.lat , packet1.lon , packet1.alt , packet1.std_dev_horz , packet1.std_dev_vert , packet1.vn , packet1.ve , packet1.vd , packet1.lat_int , packet1.lon_int );
- mavlink_msg_sim_state_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_sim_state_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.q1 , packet1.q2 , packet1.q3 , packet1.q4 , packet1.roll , packet1.pitch , packet1.yaw , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.lat , packet1.lon , packet1.alt , packet1.std_dev_horz , packet1.std_dev_vert , packet1.vn , packet1.ve , packet1.vd , packet1.lat_int , packet1.lon_int );
- mavlink_msg_sim_state_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_sim_state_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_sim_state_send(MAVLINK_COMM_1 , packet1.q1 , packet1.q2 , packet1.q3 , packet1.q4 , packet1.roll , packet1.pitch , packet1.yaw , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.lat , packet1.lon , packet1.alt , packet1.std_dev_horz , packet1.std_dev_vert , packet1.vn , packet1.ve , packet1.vd , packet1.lat_int , packet1.lon_int );
- mavlink_msg_sim_state_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SIM_STATE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SIM_STATE) != NULL);
- #endif
- }
- static void mavlink_test_radio_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_RADIO_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_radio_status_t packet_in = {
- 17235,17339,17,84,151,218,29
- };
- mavlink_radio_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.rxerrors = packet_in.rxerrors;
- packet1.fixed = packet_in.fixed;
- packet1.rssi = packet_in.rssi;
- packet1.remrssi = packet_in.remrssi;
- packet1.txbuf = packet_in.txbuf;
- packet1.noise = packet_in.noise;
- packet1.remnoise = packet_in.remnoise;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_RADIO_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_RADIO_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_radio_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_radio_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_radio_status_pack(system_id, component_id, &msg , packet1.rssi , packet1.remrssi , packet1.txbuf , packet1.noise , packet1.remnoise , packet1.rxerrors , packet1.fixed );
- mavlink_msg_radio_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_radio_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.rssi , packet1.remrssi , packet1.txbuf , packet1.noise , packet1.remnoise , packet1.rxerrors , packet1.fixed );
- mavlink_msg_radio_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_radio_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_radio_status_send(MAVLINK_COMM_1 , packet1.rssi , packet1.remrssi , packet1.txbuf , packet1.noise , packet1.remnoise , packet1.rxerrors , packet1.fixed );
- mavlink_msg_radio_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("RADIO_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_RADIO_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_file_transfer_protocol(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_FILE_TRANSFER_PROTOCOL >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_file_transfer_protocol_t packet_in = {
- 5,72,139,{ 206, 207, 208, 209, 210, 211, 212, 213, 214, 215, 216, 217, 218, 219, 220, 221, 222, 223, 224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238, 239, 240, 241, 242, 243, 244, 245, 246, 247, 248, 249, 250, 251, 252, 253, 254, 255, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78, 79, 80, 81, 82, 83, 84, 85, 86, 87, 88, 89, 90, 91, 92, 93, 94, 95, 96, 97, 98, 99, 100, 101, 102, 103, 104, 105, 106, 107, 108, 109, 110, 111, 112, 113, 114, 115, 116, 117, 118, 119, 120, 121, 122, 123, 124, 125, 126, 127, 128, 129, 130, 131, 132, 133, 134, 135, 136, 137, 138, 139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154, 155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166, 167, 168, 169, 170, 171, 172, 173, 174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184, 185, 186, 187, 188, 189, 190, 191, 192, 193, 194, 195, 196, 197, 198, 199, 200 }
- };
- mavlink_file_transfer_protocol_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_network = packet_in.target_network;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
- mav_array_memcpy(packet1.payload, packet_in.payload, sizeof(uint8_t)*251);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_FILE_TRANSFER_PROTOCOL_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_FILE_TRANSFER_PROTOCOL_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_file_transfer_protocol_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_file_transfer_protocol_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_file_transfer_protocol_pack(system_id, component_id, &msg , packet1.target_network , packet1.target_system , packet1.target_component , packet1.payload );
- mavlink_msg_file_transfer_protocol_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_file_transfer_protocol_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_network , packet1.target_system , packet1.target_component , packet1.payload );
- mavlink_msg_file_transfer_protocol_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_file_transfer_protocol_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_file_transfer_protocol_send(MAVLINK_COMM_1 , packet1.target_network , packet1.target_system , packet1.target_component , packet1.payload );
- mavlink_msg_file_transfer_protocol_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("FILE_TRANSFER_PROTOCOL") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_FILE_TRANSFER_PROTOCOL) != NULL);
- #endif
- }
- static void mavlink_test_timesync(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_TIMESYNC >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_timesync_t packet_in = {
- 93372036854775807LL,93372036854776311LL,53,120
- };
- mavlink_timesync_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.tc1 = packet_in.tc1;
- packet1.ts1 = packet_in.ts1;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_TIMESYNC_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_TIMESYNC_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_timesync_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_timesync_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_timesync_pack(system_id, component_id, &msg , packet1.tc1 , packet1.ts1 , packet1.target_system , packet1.target_component );
- mavlink_msg_timesync_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_timesync_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.tc1 , packet1.ts1 , packet1.target_system , packet1.target_component );
- mavlink_msg_timesync_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_timesync_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_timesync_send(MAVLINK_COMM_1 , packet1.tc1 , packet1.ts1 , packet1.target_system , packet1.target_component );
- mavlink_msg_timesync_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("TIMESYNC") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_TIMESYNC) != NULL);
- #endif
- }
- static void mavlink_test_camera_trigger(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CAMERA_TRIGGER >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_camera_trigger_t packet_in = {
- 93372036854775807ULL,963497880
- };
- mavlink_camera_trigger_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.seq = packet_in.seq;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CAMERA_TRIGGER_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CAMERA_TRIGGER_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_trigger_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_camera_trigger_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_trigger_pack(system_id, component_id, &msg , packet1.time_usec , packet1.seq );
- mavlink_msg_camera_trigger_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_trigger_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.seq );
- mavlink_msg_camera_trigger_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_camera_trigger_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_trigger_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.seq );
- mavlink_msg_camera_trigger_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CAMERA_TRIGGER") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CAMERA_TRIGGER) != NULL);
- #endif
- }
- static void mavlink_test_hil_gps(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_HIL_GPS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_hil_gps_t packet_in = {
- 93372036854775807ULL,963497880,963498088,963498296,18275,18379,18483,18587,18691,18795,18899,235,46,113,19159
- };
- mavlink_hil_gps_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.alt = packet_in.alt;
- packet1.eph = packet_in.eph;
- packet1.epv = packet_in.epv;
- packet1.vel = packet_in.vel;
- packet1.vn = packet_in.vn;
- packet1.ve = packet_in.ve;
- packet1.vd = packet_in.vd;
- packet1.cog = packet_in.cog;
- packet1.fix_type = packet_in.fix_type;
- packet1.satellites_visible = packet_in.satellites_visible;
- packet1.id = packet_in.id;
- packet1.yaw = packet_in.yaw;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_HIL_GPS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_HIL_GPS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_gps_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_hil_gps_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_gps_pack(system_id, component_id, &msg , packet1.time_usec , packet1.fix_type , packet1.lat , packet1.lon , packet1.alt , packet1.eph , packet1.epv , packet1.vel , packet1.vn , packet1.ve , packet1.vd , packet1.cog , packet1.satellites_visible , packet1.id , packet1.yaw );
- mavlink_msg_hil_gps_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_gps_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.fix_type , packet1.lat , packet1.lon , packet1.alt , packet1.eph , packet1.epv , packet1.vel , packet1.vn , packet1.ve , packet1.vd , packet1.cog , packet1.satellites_visible , packet1.id , packet1.yaw );
- mavlink_msg_hil_gps_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_hil_gps_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_gps_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.fix_type , packet1.lat , packet1.lon , packet1.alt , packet1.eph , packet1.epv , packet1.vel , packet1.vn , packet1.ve , packet1.vd , packet1.cog , packet1.satellites_visible , packet1.id , packet1.yaw );
- mavlink_msg_hil_gps_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("HIL_GPS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_HIL_GPS) != NULL);
- #endif
- }
- static void mavlink_test_hil_optical_flow(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_HIL_OPTICAL_FLOW >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_hil_optical_flow_t packet_in = {
- 93372036854775807ULL,963497880,101.0,129.0,157.0,185.0,213.0,963499128,269.0,19315,3,70
- };
- mavlink_hil_optical_flow_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.integration_time_us = packet_in.integration_time_us;
- packet1.integrated_x = packet_in.integrated_x;
- packet1.integrated_y = packet_in.integrated_y;
- packet1.integrated_xgyro = packet_in.integrated_xgyro;
- packet1.integrated_ygyro = packet_in.integrated_ygyro;
- packet1.integrated_zgyro = packet_in.integrated_zgyro;
- packet1.time_delta_distance_us = packet_in.time_delta_distance_us;
- packet1.distance = packet_in.distance;
- packet1.temperature = packet_in.temperature;
- packet1.sensor_id = packet_in.sensor_id;
- packet1.quality = packet_in.quality;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_HIL_OPTICAL_FLOW_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_HIL_OPTICAL_FLOW_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_optical_flow_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_hil_optical_flow_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_optical_flow_pack(system_id, component_id, &msg , packet1.time_usec , packet1.sensor_id , packet1.integration_time_us , packet1.integrated_x , packet1.integrated_y , packet1.integrated_xgyro , packet1.integrated_ygyro , packet1.integrated_zgyro , packet1.temperature , packet1.quality , packet1.time_delta_distance_us , packet1.distance );
- mavlink_msg_hil_optical_flow_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_optical_flow_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.sensor_id , packet1.integration_time_us , packet1.integrated_x , packet1.integrated_y , packet1.integrated_xgyro , packet1.integrated_ygyro , packet1.integrated_zgyro , packet1.temperature , packet1.quality , packet1.time_delta_distance_us , packet1.distance );
- mavlink_msg_hil_optical_flow_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_hil_optical_flow_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_optical_flow_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.sensor_id , packet1.integration_time_us , packet1.integrated_x , packet1.integrated_y , packet1.integrated_xgyro , packet1.integrated_ygyro , packet1.integrated_zgyro , packet1.temperature , packet1.quality , packet1.time_delta_distance_us , packet1.distance );
- mavlink_msg_hil_optical_flow_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("HIL_OPTICAL_FLOW") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_HIL_OPTICAL_FLOW) != NULL);
- #endif
- }
- static void mavlink_test_hil_state_quaternion(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_HIL_STATE_QUATERNION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_hil_state_quaternion_t packet_in = {
- 93372036854775807ULL,{ 73.0, 74.0, 75.0, 76.0 },185.0,213.0,241.0,963499336,963499544,963499752,19731,19835,19939,20043,20147,20251,20355,20459
- };
- mavlink_hil_state_quaternion_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.rollspeed = packet_in.rollspeed;
- packet1.pitchspeed = packet_in.pitchspeed;
- packet1.yawspeed = packet_in.yawspeed;
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.alt = packet_in.alt;
- packet1.vx = packet_in.vx;
- packet1.vy = packet_in.vy;
- packet1.vz = packet_in.vz;
- packet1.ind_airspeed = packet_in.ind_airspeed;
- packet1.true_airspeed = packet_in.true_airspeed;
- packet1.xacc = packet_in.xacc;
- packet1.yacc = packet_in.yacc;
- packet1.zacc = packet_in.zacc;
-
- mav_array_memcpy(packet1.attitude_quaternion, packet_in.attitude_quaternion, sizeof(float)*4);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_HIL_STATE_QUATERNION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_HIL_STATE_QUATERNION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_state_quaternion_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_hil_state_quaternion_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_state_quaternion_pack(system_id, component_id, &msg , packet1.time_usec , packet1.attitude_quaternion , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed , packet1.lat , packet1.lon , packet1.alt , packet1.vx , packet1.vy , packet1.vz , packet1.ind_airspeed , packet1.true_airspeed , packet1.xacc , packet1.yacc , packet1.zacc );
- mavlink_msg_hil_state_quaternion_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_state_quaternion_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.attitude_quaternion , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed , packet1.lat , packet1.lon , packet1.alt , packet1.vx , packet1.vy , packet1.vz , packet1.ind_airspeed , packet1.true_airspeed , packet1.xacc , packet1.yacc , packet1.zacc );
- mavlink_msg_hil_state_quaternion_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_hil_state_quaternion_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hil_state_quaternion_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.attitude_quaternion , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed , packet1.lat , packet1.lon , packet1.alt , packet1.vx , packet1.vy , packet1.vz , packet1.ind_airspeed , packet1.true_airspeed , packet1.xacc , packet1.yacc , packet1.zacc );
- mavlink_msg_hil_state_quaternion_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("HIL_STATE_QUATERNION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_HIL_STATE_QUATERNION) != NULL);
- #endif
- }
- static void mavlink_test_scaled_imu2(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SCALED_IMU2 >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_scaled_imu2_t packet_in = {
- 963497464,17443,17547,17651,17755,17859,17963,18067,18171,18275,18379
- };
- mavlink_scaled_imu2_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.xacc = packet_in.xacc;
- packet1.yacc = packet_in.yacc;
- packet1.zacc = packet_in.zacc;
- packet1.xgyro = packet_in.xgyro;
- packet1.ygyro = packet_in.ygyro;
- packet1.zgyro = packet_in.zgyro;
- packet1.xmag = packet_in.xmag;
- packet1.ymag = packet_in.ymag;
- packet1.zmag = packet_in.zmag;
- packet1.temperature = packet_in.temperature;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SCALED_IMU2_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SCALED_IMU2_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_imu2_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_scaled_imu2_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_imu2_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.temperature );
- mavlink_msg_scaled_imu2_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_imu2_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.temperature );
- mavlink_msg_scaled_imu2_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_scaled_imu2_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_imu2_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.temperature );
- mavlink_msg_scaled_imu2_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SCALED_IMU2") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SCALED_IMU2) != NULL);
- #endif
- }
- static void mavlink_test_log_request_list(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_LOG_REQUEST_LIST >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_log_request_list_t packet_in = {
- 17235,17339,17,84
- };
- mavlink_log_request_list_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.start = packet_in.start;
- packet1.end = packet_in.end;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_LOG_REQUEST_LIST_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_LOG_REQUEST_LIST_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_request_list_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_log_request_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_request_list_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.start , packet1.end );
- mavlink_msg_log_request_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_request_list_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.start , packet1.end );
- mavlink_msg_log_request_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_log_request_list_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_request_list_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.start , packet1.end );
- mavlink_msg_log_request_list_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("LOG_REQUEST_LIST") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_LOG_REQUEST_LIST) != NULL);
- #endif
- }
- static void mavlink_test_log_entry(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_LOG_ENTRY >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_log_entry_t packet_in = {
- 963497464,963497672,17651,17755,17859
- };
- mavlink_log_entry_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_utc = packet_in.time_utc;
- packet1.size = packet_in.size;
- packet1.id = packet_in.id;
- packet1.num_logs = packet_in.num_logs;
- packet1.last_log_num = packet_in.last_log_num;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_LOG_ENTRY_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_LOG_ENTRY_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_entry_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_log_entry_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_entry_pack(system_id, component_id, &msg , packet1.id , packet1.num_logs , packet1.last_log_num , packet1.time_utc , packet1.size );
- mavlink_msg_log_entry_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_entry_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.id , packet1.num_logs , packet1.last_log_num , packet1.time_utc , packet1.size );
- mavlink_msg_log_entry_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_log_entry_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_entry_send(MAVLINK_COMM_1 , packet1.id , packet1.num_logs , packet1.last_log_num , packet1.time_utc , packet1.size );
- mavlink_msg_log_entry_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("LOG_ENTRY") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_LOG_ENTRY) != NULL);
- #endif
- }
- static void mavlink_test_log_request_data(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_LOG_REQUEST_DATA >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_log_request_data_t packet_in = {
- 963497464,963497672,17651,163,230
- };
- mavlink_log_request_data_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.ofs = packet_in.ofs;
- packet1.count = packet_in.count;
- packet1.id = packet_in.id;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_LOG_REQUEST_DATA_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_LOG_REQUEST_DATA_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_request_data_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_log_request_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_request_data_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.id , packet1.ofs , packet1.count );
- mavlink_msg_log_request_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_request_data_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.id , packet1.ofs , packet1.count );
- mavlink_msg_log_request_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_log_request_data_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_request_data_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.id , packet1.ofs , packet1.count );
- mavlink_msg_log_request_data_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("LOG_REQUEST_DATA") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_LOG_REQUEST_DATA) != NULL);
- #endif
- }
- static void mavlink_test_log_data(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_LOG_DATA >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_log_data_t packet_in = {
- 963497464,17443,151,{ 218, 219, 220, 221, 222, 223, 224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238, 239, 240, 241, 242, 243, 244, 245, 246, 247, 248, 249, 250, 251, 252, 253, 254, 255, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, 48, 49, 50, 51 }
- };
- mavlink_log_data_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.ofs = packet_in.ofs;
- packet1.id = packet_in.id;
- packet1.count = packet_in.count;
-
- mav_array_memcpy(packet1.data, packet_in.data, sizeof(uint8_t)*90);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_LOG_DATA_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_LOG_DATA_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_data_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_log_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_data_pack(system_id, component_id, &msg , packet1.id , packet1.ofs , packet1.count , packet1.data );
- mavlink_msg_log_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_data_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.id , packet1.ofs , packet1.count , packet1.data );
- mavlink_msg_log_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_log_data_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_data_send(MAVLINK_COMM_1 , packet1.id , packet1.ofs , packet1.count , packet1.data );
- mavlink_msg_log_data_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("LOG_DATA") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_LOG_DATA) != NULL);
- #endif
- }
- static void mavlink_test_log_erase(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_LOG_ERASE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_log_erase_t packet_in = {
- 5,72
- };
- mavlink_log_erase_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_LOG_ERASE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_LOG_ERASE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_erase_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_log_erase_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_erase_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component );
- mavlink_msg_log_erase_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_erase_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component );
- mavlink_msg_log_erase_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_log_erase_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_erase_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component );
- mavlink_msg_log_erase_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("LOG_ERASE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_LOG_ERASE) != NULL);
- #endif
- }
- static void mavlink_test_log_request_end(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_LOG_REQUEST_END >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_log_request_end_t packet_in = {
- 5,72
- };
- mavlink_log_request_end_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_LOG_REQUEST_END_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_LOG_REQUEST_END_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_request_end_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_log_request_end_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_request_end_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component );
- mavlink_msg_log_request_end_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_request_end_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component );
- mavlink_msg_log_request_end_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_log_request_end_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_log_request_end_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component );
- mavlink_msg_log_request_end_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("LOG_REQUEST_END") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_LOG_REQUEST_END) != NULL);
- #endif
- }
- static void mavlink_test_gps_inject_data(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GPS_INJECT_DATA >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gps_inject_data_t packet_in = {
- 5,72,139,{ 206, 207, 208, 209, 210, 211, 212, 213, 214, 215, 216, 217, 218, 219, 220, 221, 222, 223, 224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238, 239, 240, 241, 242, 243, 244, 245, 246, 247, 248, 249, 250, 251, 252, 253, 254, 255, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59 }
- };
- mavlink_gps_inject_data_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.len = packet_in.len;
-
- mav_array_memcpy(packet1.data, packet_in.data, sizeof(uint8_t)*110);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GPS_INJECT_DATA_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GPS_INJECT_DATA_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_inject_data_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gps_inject_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_inject_data_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.len , packet1.data );
- mavlink_msg_gps_inject_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_inject_data_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.len , packet1.data );
- mavlink_msg_gps_inject_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gps_inject_data_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_inject_data_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.len , packet1.data );
- mavlink_msg_gps_inject_data_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GPS_INJECT_DATA") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GPS_INJECT_DATA) != NULL);
- #endif
- }
- static void mavlink_test_gps2_raw(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GPS2_RAW >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gps2_raw_t packet_in = {
- 93372036854775807ULL,963497880,963498088,963498296,963498504,18483,18587,18691,18795,101,168,235,19055,963499388,963499596,963499804,963500012,963500220
- };
- mavlink_gps2_raw_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.alt = packet_in.alt;
- packet1.dgps_age = packet_in.dgps_age;
- packet1.eph = packet_in.eph;
- packet1.epv = packet_in.epv;
- packet1.vel = packet_in.vel;
- packet1.cog = packet_in.cog;
- packet1.fix_type = packet_in.fix_type;
- packet1.satellites_visible = packet_in.satellites_visible;
- packet1.dgps_numch = packet_in.dgps_numch;
- packet1.yaw = packet_in.yaw;
- packet1.alt_ellipsoid = packet_in.alt_ellipsoid;
- packet1.h_acc = packet_in.h_acc;
- packet1.v_acc = packet_in.v_acc;
- packet1.vel_acc = packet_in.vel_acc;
- packet1.hdg_acc = packet_in.hdg_acc;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GPS2_RAW_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GPS2_RAW_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps2_raw_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gps2_raw_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps2_raw_pack(system_id, component_id, &msg , packet1.time_usec , packet1.fix_type , packet1.lat , packet1.lon , packet1.alt , packet1.eph , packet1.epv , packet1.vel , packet1.cog , packet1.satellites_visible , packet1.dgps_numch , packet1.dgps_age , packet1.yaw , packet1.alt_ellipsoid , packet1.h_acc , packet1.v_acc , packet1.vel_acc , packet1.hdg_acc );
- mavlink_msg_gps2_raw_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps2_raw_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.fix_type , packet1.lat , packet1.lon , packet1.alt , packet1.eph , packet1.epv , packet1.vel , packet1.cog , packet1.satellites_visible , packet1.dgps_numch , packet1.dgps_age , packet1.yaw , packet1.alt_ellipsoid , packet1.h_acc , packet1.v_acc , packet1.vel_acc , packet1.hdg_acc );
- mavlink_msg_gps2_raw_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gps2_raw_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps2_raw_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.fix_type , packet1.lat , packet1.lon , packet1.alt , packet1.eph , packet1.epv , packet1.vel , packet1.cog , packet1.satellites_visible , packet1.dgps_numch , packet1.dgps_age , packet1.yaw , packet1.alt_ellipsoid , packet1.h_acc , packet1.v_acc , packet1.vel_acc , packet1.hdg_acc );
- mavlink_msg_gps2_raw_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GPS2_RAW") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GPS2_RAW) != NULL);
- #endif
- }
- static void mavlink_test_power_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_POWER_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_power_status_t packet_in = {
- 17235,17339,17443
- };
- mavlink_power_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.Vcc = packet_in.Vcc;
- packet1.Vservo = packet_in.Vservo;
- packet1.flags = packet_in.flags;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_POWER_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_POWER_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_power_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_power_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_power_status_pack(system_id, component_id, &msg , packet1.Vcc , packet1.Vservo , packet1.flags );
- mavlink_msg_power_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_power_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.Vcc , packet1.Vservo , packet1.flags );
- mavlink_msg_power_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_power_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_power_status_send(MAVLINK_COMM_1 , packet1.Vcc , packet1.Vservo , packet1.flags );
- mavlink_msg_power_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("POWER_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_POWER_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_serial_control(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SERIAL_CONTROL >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_serial_control_t packet_in = {
- 963497464,17443,151,218,29,{ 96, 97, 98, 99, 100, 101, 102, 103, 104, 105, 106, 107, 108, 109, 110, 111, 112, 113, 114, 115, 116, 117, 118, 119, 120, 121, 122, 123, 124, 125, 126, 127, 128, 129, 130, 131, 132, 133, 134, 135, 136, 137, 138, 139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154, 155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165 },178,245
- };
- mavlink_serial_control_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.baudrate = packet_in.baudrate;
- packet1.timeout = packet_in.timeout;
- packet1.device = packet_in.device;
- packet1.flags = packet_in.flags;
- packet1.count = packet_in.count;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
- mav_array_memcpy(packet1.data, packet_in.data, sizeof(uint8_t)*70);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SERIAL_CONTROL_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SERIAL_CONTROL_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_serial_control_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_serial_control_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_serial_control_pack(system_id, component_id, &msg , packet1.device , packet1.flags , packet1.timeout , packet1.baudrate , packet1.count , packet1.data , packet1.target_system , packet1.target_component );
- mavlink_msg_serial_control_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_serial_control_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.device , packet1.flags , packet1.timeout , packet1.baudrate , packet1.count , packet1.data , packet1.target_system , packet1.target_component );
- mavlink_msg_serial_control_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_serial_control_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_serial_control_send(MAVLINK_COMM_1 , packet1.device , packet1.flags , packet1.timeout , packet1.baudrate , packet1.count , packet1.data , packet1.target_system , packet1.target_component );
- mavlink_msg_serial_control_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SERIAL_CONTROL") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SERIAL_CONTROL) != NULL);
- #endif
- }
- static void mavlink_test_gps_rtk(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GPS_RTK >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gps_rtk_t packet_in = {
- 963497464,963497672,963497880,963498088,963498296,963498504,963498712,18691,223,34,101,168,235
- };
- mavlink_gps_rtk_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_last_baseline_ms = packet_in.time_last_baseline_ms;
- packet1.tow = packet_in.tow;
- packet1.baseline_a_mm = packet_in.baseline_a_mm;
- packet1.baseline_b_mm = packet_in.baseline_b_mm;
- packet1.baseline_c_mm = packet_in.baseline_c_mm;
- packet1.accuracy = packet_in.accuracy;
- packet1.iar_num_hypotheses = packet_in.iar_num_hypotheses;
- packet1.wn = packet_in.wn;
- packet1.rtk_receiver_id = packet_in.rtk_receiver_id;
- packet1.rtk_health = packet_in.rtk_health;
- packet1.rtk_rate = packet_in.rtk_rate;
- packet1.nsats = packet_in.nsats;
- packet1.baseline_coords_type = packet_in.baseline_coords_type;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GPS_RTK_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GPS_RTK_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_rtk_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gps_rtk_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_rtk_pack(system_id, component_id, &msg , packet1.time_last_baseline_ms , packet1.rtk_receiver_id , packet1.wn , packet1.tow , packet1.rtk_health , packet1.rtk_rate , packet1.nsats , packet1.baseline_coords_type , packet1.baseline_a_mm , packet1.baseline_b_mm , packet1.baseline_c_mm , packet1.accuracy , packet1.iar_num_hypotheses );
- mavlink_msg_gps_rtk_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_rtk_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_last_baseline_ms , packet1.rtk_receiver_id , packet1.wn , packet1.tow , packet1.rtk_health , packet1.rtk_rate , packet1.nsats , packet1.baseline_coords_type , packet1.baseline_a_mm , packet1.baseline_b_mm , packet1.baseline_c_mm , packet1.accuracy , packet1.iar_num_hypotheses );
- mavlink_msg_gps_rtk_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gps_rtk_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_rtk_send(MAVLINK_COMM_1 , packet1.time_last_baseline_ms , packet1.rtk_receiver_id , packet1.wn , packet1.tow , packet1.rtk_health , packet1.rtk_rate , packet1.nsats , packet1.baseline_coords_type , packet1.baseline_a_mm , packet1.baseline_b_mm , packet1.baseline_c_mm , packet1.accuracy , packet1.iar_num_hypotheses );
- mavlink_msg_gps_rtk_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GPS_RTK") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GPS_RTK) != NULL);
- #endif
- }
- static void mavlink_test_gps2_rtk(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GPS2_RTK >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gps2_rtk_t packet_in = {
- 963497464,963497672,963497880,963498088,963498296,963498504,963498712,18691,223,34,101,168,235
- };
- mavlink_gps2_rtk_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_last_baseline_ms = packet_in.time_last_baseline_ms;
- packet1.tow = packet_in.tow;
- packet1.baseline_a_mm = packet_in.baseline_a_mm;
- packet1.baseline_b_mm = packet_in.baseline_b_mm;
- packet1.baseline_c_mm = packet_in.baseline_c_mm;
- packet1.accuracy = packet_in.accuracy;
- packet1.iar_num_hypotheses = packet_in.iar_num_hypotheses;
- packet1.wn = packet_in.wn;
- packet1.rtk_receiver_id = packet_in.rtk_receiver_id;
- packet1.rtk_health = packet_in.rtk_health;
- packet1.rtk_rate = packet_in.rtk_rate;
- packet1.nsats = packet_in.nsats;
- packet1.baseline_coords_type = packet_in.baseline_coords_type;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GPS2_RTK_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GPS2_RTK_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps2_rtk_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gps2_rtk_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps2_rtk_pack(system_id, component_id, &msg , packet1.time_last_baseline_ms , packet1.rtk_receiver_id , packet1.wn , packet1.tow , packet1.rtk_health , packet1.rtk_rate , packet1.nsats , packet1.baseline_coords_type , packet1.baseline_a_mm , packet1.baseline_b_mm , packet1.baseline_c_mm , packet1.accuracy , packet1.iar_num_hypotheses );
- mavlink_msg_gps2_rtk_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps2_rtk_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_last_baseline_ms , packet1.rtk_receiver_id , packet1.wn , packet1.tow , packet1.rtk_health , packet1.rtk_rate , packet1.nsats , packet1.baseline_coords_type , packet1.baseline_a_mm , packet1.baseline_b_mm , packet1.baseline_c_mm , packet1.accuracy , packet1.iar_num_hypotheses );
- mavlink_msg_gps2_rtk_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gps2_rtk_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps2_rtk_send(MAVLINK_COMM_1 , packet1.time_last_baseline_ms , packet1.rtk_receiver_id , packet1.wn , packet1.tow , packet1.rtk_health , packet1.rtk_rate , packet1.nsats , packet1.baseline_coords_type , packet1.baseline_a_mm , packet1.baseline_b_mm , packet1.baseline_c_mm , packet1.accuracy , packet1.iar_num_hypotheses );
- mavlink_msg_gps2_rtk_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GPS2_RTK") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GPS2_RTK) != NULL);
- #endif
- }
- static void mavlink_test_scaled_imu3(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SCALED_IMU3 >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_scaled_imu3_t packet_in = {
- 963497464,17443,17547,17651,17755,17859,17963,18067,18171,18275,18379
- };
- mavlink_scaled_imu3_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.xacc = packet_in.xacc;
- packet1.yacc = packet_in.yacc;
- packet1.zacc = packet_in.zacc;
- packet1.xgyro = packet_in.xgyro;
- packet1.ygyro = packet_in.ygyro;
- packet1.zgyro = packet_in.zgyro;
- packet1.xmag = packet_in.xmag;
- packet1.ymag = packet_in.ymag;
- packet1.zmag = packet_in.zmag;
- packet1.temperature = packet_in.temperature;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SCALED_IMU3_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SCALED_IMU3_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_imu3_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_scaled_imu3_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_imu3_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.temperature );
- mavlink_msg_scaled_imu3_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_imu3_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.temperature );
- mavlink_msg_scaled_imu3_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_scaled_imu3_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_imu3_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.xacc , packet1.yacc , packet1.zacc , packet1.xgyro , packet1.ygyro , packet1.zgyro , packet1.xmag , packet1.ymag , packet1.zmag , packet1.temperature );
- mavlink_msg_scaled_imu3_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SCALED_IMU3") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SCALED_IMU3) != NULL);
- #endif
- }
- static void mavlink_test_data_transmission_handshake(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_DATA_TRANSMISSION_HANDSHAKE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_data_transmission_handshake_t packet_in = {
- 963497464,17443,17547,17651,163,230,41
- };
- mavlink_data_transmission_handshake_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.size = packet_in.size;
- packet1.width = packet_in.width;
- packet1.height = packet_in.height;
- packet1.packets = packet_in.packets;
- packet1.type = packet_in.type;
- packet1.payload = packet_in.payload;
- packet1.jpg_quality = packet_in.jpg_quality;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_DATA_TRANSMISSION_HANDSHAKE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_DATA_TRANSMISSION_HANDSHAKE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_data_transmission_handshake_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_data_transmission_handshake_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_data_transmission_handshake_pack(system_id, component_id, &msg , packet1.type , packet1.size , packet1.width , packet1.height , packet1.packets , packet1.payload , packet1.jpg_quality );
- mavlink_msg_data_transmission_handshake_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_data_transmission_handshake_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.type , packet1.size , packet1.width , packet1.height , packet1.packets , packet1.payload , packet1.jpg_quality );
- mavlink_msg_data_transmission_handshake_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_data_transmission_handshake_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_data_transmission_handshake_send(MAVLINK_COMM_1 , packet1.type , packet1.size , packet1.width , packet1.height , packet1.packets , packet1.payload , packet1.jpg_quality );
- mavlink_msg_data_transmission_handshake_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("DATA_TRANSMISSION_HANDSHAKE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_DATA_TRANSMISSION_HANDSHAKE) != NULL);
- #endif
- }
- static void mavlink_test_encapsulated_data(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ENCAPSULATED_DATA >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_encapsulated_data_t packet_in = {
- 17235,{ 139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154, 155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166, 167, 168, 169, 170, 171, 172, 173, 174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184, 185, 186, 187, 188, 189, 190, 191, 192, 193, 194, 195, 196, 197, 198, 199, 200, 201, 202, 203, 204, 205, 206, 207, 208, 209, 210, 211, 212, 213, 214, 215, 216, 217, 218, 219, 220, 221, 222, 223, 224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238, 239, 240, 241, 242, 243, 244, 245, 246, 247, 248, 249, 250, 251, 252, 253, 254, 255, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78, 79, 80, 81, 82, 83, 84, 85, 86, 87, 88, 89, 90, 91, 92, 93, 94, 95, 96, 97, 98, 99, 100, 101, 102, 103, 104, 105, 106, 107, 108, 109, 110, 111, 112, 113, 114, 115, 116, 117, 118, 119, 120, 121, 122, 123, 124, 125, 126, 127, 128, 129, 130, 131, 132, 133, 134, 135 }
- };
- mavlink_encapsulated_data_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.seqnr = packet_in.seqnr;
-
- mav_array_memcpy(packet1.data, packet_in.data, sizeof(uint8_t)*253);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ENCAPSULATED_DATA_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ENCAPSULATED_DATA_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_encapsulated_data_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_encapsulated_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_encapsulated_data_pack(system_id, component_id, &msg , packet1.seqnr , packet1.data );
- mavlink_msg_encapsulated_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_encapsulated_data_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.seqnr , packet1.data );
- mavlink_msg_encapsulated_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_encapsulated_data_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_encapsulated_data_send(MAVLINK_COMM_1 , packet1.seqnr , packet1.data );
- mavlink_msg_encapsulated_data_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ENCAPSULATED_DATA") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ENCAPSULATED_DATA) != NULL);
- #endif
- }
- static void mavlink_test_distance_sensor(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_DISTANCE_SENSOR >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_distance_sensor_t packet_in = {
- 963497464,17443,17547,17651,163,230,41,108,115.0,143.0,{ 171.0, 172.0, 173.0, 174.0 },247
- };
- mavlink_distance_sensor_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.min_distance = packet_in.min_distance;
- packet1.max_distance = packet_in.max_distance;
- packet1.current_distance = packet_in.current_distance;
- packet1.type = packet_in.type;
- packet1.id = packet_in.id;
- packet1.orientation = packet_in.orientation;
- packet1.covariance = packet_in.covariance;
- packet1.horizontal_fov = packet_in.horizontal_fov;
- packet1.vertical_fov = packet_in.vertical_fov;
- packet1.signal_quality = packet_in.signal_quality;
-
- mav_array_memcpy(packet1.quaternion, packet_in.quaternion, sizeof(float)*4);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_DISTANCE_SENSOR_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_DISTANCE_SENSOR_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_distance_sensor_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_distance_sensor_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_distance_sensor_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.min_distance , packet1.max_distance , packet1.current_distance , packet1.type , packet1.id , packet1.orientation , packet1.covariance , packet1.horizontal_fov , packet1.vertical_fov , packet1.quaternion , packet1.signal_quality );
- mavlink_msg_distance_sensor_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_distance_sensor_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.min_distance , packet1.max_distance , packet1.current_distance , packet1.type , packet1.id , packet1.orientation , packet1.covariance , packet1.horizontal_fov , packet1.vertical_fov , packet1.quaternion , packet1.signal_quality );
- mavlink_msg_distance_sensor_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_distance_sensor_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_distance_sensor_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.min_distance , packet1.max_distance , packet1.current_distance , packet1.type , packet1.id , packet1.orientation , packet1.covariance , packet1.horizontal_fov , packet1.vertical_fov , packet1.quaternion , packet1.signal_quality );
- mavlink_msg_distance_sensor_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("DISTANCE_SENSOR") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_DISTANCE_SENSOR) != NULL);
- #endif
- }
- static void mavlink_test_terrain_request(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_TERRAIN_REQUEST >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_terrain_request_t packet_in = {
- 93372036854775807ULL,963497880,963498088,18067
- };
- mavlink_terrain_request_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.mask = packet_in.mask;
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.grid_spacing = packet_in.grid_spacing;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_TERRAIN_REQUEST_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_TERRAIN_REQUEST_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_terrain_request_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_terrain_request_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_terrain_request_pack(system_id, component_id, &msg , packet1.lat , packet1.lon , packet1.grid_spacing , packet1.mask );
- mavlink_msg_terrain_request_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_terrain_request_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.lat , packet1.lon , packet1.grid_spacing , packet1.mask );
- mavlink_msg_terrain_request_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_terrain_request_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_terrain_request_send(MAVLINK_COMM_1 , packet1.lat , packet1.lon , packet1.grid_spacing , packet1.mask );
- mavlink_msg_terrain_request_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("TERRAIN_REQUEST") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_TERRAIN_REQUEST) != NULL);
- #endif
- }
- static void mavlink_test_terrain_data(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_TERRAIN_DATA >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_terrain_data_t packet_in = {
- 963497464,963497672,17651,{ 17755, 17756, 17757, 17758, 17759, 17760, 17761, 17762, 17763, 17764, 17765, 17766, 17767, 17768, 17769, 17770 },3
- };
- mavlink_terrain_data_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.grid_spacing = packet_in.grid_spacing;
- packet1.gridbit = packet_in.gridbit;
-
- mav_array_memcpy(packet1.data, packet_in.data, sizeof(int16_t)*16);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_TERRAIN_DATA_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_TERRAIN_DATA_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_terrain_data_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_terrain_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_terrain_data_pack(system_id, component_id, &msg , packet1.lat , packet1.lon , packet1.grid_spacing , packet1.gridbit , packet1.data );
- mavlink_msg_terrain_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_terrain_data_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.lat , packet1.lon , packet1.grid_spacing , packet1.gridbit , packet1.data );
- mavlink_msg_terrain_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_terrain_data_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_terrain_data_send(MAVLINK_COMM_1 , packet1.lat , packet1.lon , packet1.grid_spacing , packet1.gridbit , packet1.data );
- mavlink_msg_terrain_data_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("TERRAIN_DATA") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_TERRAIN_DATA) != NULL);
- #endif
- }
- static void mavlink_test_terrain_check(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_TERRAIN_CHECK >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_terrain_check_t packet_in = {
- 963497464,963497672
- };
- mavlink_terrain_check_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_TERRAIN_CHECK_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_TERRAIN_CHECK_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_terrain_check_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_terrain_check_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_terrain_check_pack(system_id, component_id, &msg , packet1.lat , packet1.lon );
- mavlink_msg_terrain_check_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_terrain_check_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.lat , packet1.lon );
- mavlink_msg_terrain_check_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_terrain_check_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_terrain_check_send(MAVLINK_COMM_1 , packet1.lat , packet1.lon );
- mavlink_msg_terrain_check_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("TERRAIN_CHECK") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_TERRAIN_CHECK) != NULL);
- #endif
- }
- static void mavlink_test_terrain_report(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_TERRAIN_REPORT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_terrain_report_t packet_in = {
- 963497464,963497672,73.0,101.0,18067,18171,18275
- };
- mavlink_terrain_report_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.terrain_height = packet_in.terrain_height;
- packet1.current_height = packet_in.current_height;
- packet1.spacing = packet_in.spacing;
- packet1.pending = packet_in.pending;
- packet1.loaded = packet_in.loaded;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_TERRAIN_REPORT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_TERRAIN_REPORT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_terrain_report_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_terrain_report_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_terrain_report_pack(system_id, component_id, &msg , packet1.lat , packet1.lon , packet1.spacing , packet1.terrain_height , packet1.current_height , packet1.pending , packet1.loaded );
- mavlink_msg_terrain_report_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_terrain_report_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.lat , packet1.lon , packet1.spacing , packet1.terrain_height , packet1.current_height , packet1.pending , packet1.loaded );
- mavlink_msg_terrain_report_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_terrain_report_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_terrain_report_send(MAVLINK_COMM_1 , packet1.lat , packet1.lon , packet1.spacing , packet1.terrain_height , packet1.current_height , packet1.pending , packet1.loaded );
- mavlink_msg_terrain_report_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("TERRAIN_REPORT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_TERRAIN_REPORT) != NULL);
- #endif
- }
- static void mavlink_test_scaled_pressure2(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SCALED_PRESSURE2 >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_scaled_pressure2_t packet_in = {
- 963497464,45.0,73.0,17859,17963
- };
- mavlink_scaled_pressure2_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.press_abs = packet_in.press_abs;
- packet1.press_diff = packet_in.press_diff;
- packet1.temperature = packet_in.temperature;
- packet1.temperature_press_diff = packet_in.temperature_press_diff;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SCALED_PRESSURE2_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SCALED_PRESSURE2_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_pressure2_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_scaled_pressure2_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_pressure2_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.press_abs , packet1.press_diff , packet1.temperature , packet1.temperature_press_diff );
- mavlink_msg_scaled_pressure2_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_pressure2_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.press_abs , packet1.press_diff , packet1.temperature , packet1.temperature_press_diff );
- mavlink_msg_scaled_pressure2_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_scaled_pressure2_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_pressure2_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.press_abs , packet1.press_diff , packet1.temperature , packet1.temperature_press_diff );
- mavlink_msg_scaled_pressure2_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SCALED_PRESSURE2") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SCALED_PRESSURE2) != NULL);
- #endif
- }
- static void mavlink_test_att_pos_mocap(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ATT_POS_MOCAP >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_att_pos_mocap_t packet_in = {
- 93372036854775807ULL,{ 73.0, 74.0, 75.0, 76.0 },185.0,213.0,241.0,{ 269.0, 270.0, 271.0, 272.0, 273.0, 274.0, 275.0, 276.0, 277.0, 278.0, 279.0, 280.0, 281.0, 282.0, 283.0, 284.0, 285.0, 286.0, 287.0, 288.0, 289.0 }
- };
- mavlink_att_pos_mocap_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
-
- mav_array_memcpy(packet1.q, packet_in.q, sizeof(float)*4);
- mav_array_memcpy(packet1.covariance, packet_in.covariance, sizeof(float)*21);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ATT_POS_MOCAP_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ATT_POS_MOCAP_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_att_pos_mocap_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_att_pos_mocap_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_att_pos_mocap_pack(system_id, component_id, &msg , packet1.time_usec , packet1.q , packet1.x , packet1.y , packet1.z , packet1.covariance );
- mavlink_msg_att_pos_mocap_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_att_pos_mocap_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.q , packet1.x , packet1.y , packet1.z , packet1.covariance );
- mavlink_msg_att_pos_mocap_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_att_pos_mocap_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_att_pos_mocap_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.q , packet1.x , packet1.y , packet1.z , packet1.covariance );
- mavlink_msg_att_pos_mocap_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ATT_POS_MOCAP") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ATT_POS_MOCAP) != NULL);
- #endif
- }
- static void mavlink_test_set_actuator_control_target(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SET_ACTUATOR_CONTROL_TARGET >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_set_actuator_control_target_t packet_in = {
- 93372036854775807ULL,{ 73.0, 74.0, 75.0, 76.0, 77.0, 78.0, 79.0, 80.0 },125,192,3
- };
- mavlink_set_actuator_control_target_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.group_mlx = packet_in.group_mlx;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
- mav_array_memcpy(packet1.controls, packet_in.controls, sizeof(float)*8);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SET_ACTUATOR_CONTROL_TARGET_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SET_ACTUATOR_CONTROL_TARGET_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_actuator_control_target_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_set_actuator_control_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_actuator_control_target_pack(system_id, component_id, &msg , packet1.time_usec , packet1.group_mlx , packet1.target_system , packet1.target_component , packet1.controls );
- mavlink_msg_set_actuator_control_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_actuator_control_target_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.group_mlx , packet1.target_system , packet1.target_component , packet1.controls );
- mavlink_msg_set_actuator_control_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_set_actuator_control_target_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_actuator_control_target_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.group_mlx , packet1.target_system , packet1.target_component , packet1.controls );
- mavlink_msg_set_actuator_control_target_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SET_ACTUATOR_CONTROL_TARGET") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SET_ACTUATOR_CONTROL_TARGET) != NULL);
- #endif
- }
- static void mavlink_test_actuator_control_target(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ACTUATOR_CONTROL_TARGET >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_actuator_control_target_t packet_in = {
- 93372036854775807ULL,{ 73.0, 74.0, 75.0, 76.0, 77.0, 78.0, 79.0, 80.0 },125
- };
- mavlink_actuator_control_target_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.group_mlx = packet_in.group_mlx;
-
- mav_array_memcpy(packet1.controls, packet_in.controls, sizeof(float)*8);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ACTUATOR_CONTROL_TARGET_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ACTUATOR_CONTROL_TARGET_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_actuator_control_target_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_actuator_control_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_actuator_control_target_pack(system_id, component_id, &msg , packet1.time_usec , packet1.group_mlx , packet1.controls );
- mavlink_msg_actuator_control_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_actuator_control_target_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.group_mlx , packet1.controls );
- mavlink_msg_actuator_control_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_actuator_control_target_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_actuator_control_target_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.group_mlx , packet1.controls );
- mavlink_msg_actuator_control_target_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ACTUATOR_CONTROL_TARGET") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ACTUATOR_CONTROL_TARGET) != NULL);
- #endif
- }
- static void mavlink_test_altitude(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ALTITUDE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_altitude_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,157.0,185.0,213.0
- };
- mavlink_altitude_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.altitude_monotonic = packet_in.altitude_monotonic;
- packet1.altitude_amsl = packet_in.altitude_amsl;
- packet1.altitude_local = packet_in.altitude_local;
- packet1.altitude_relative = packet_in.altitude_relative;
- packet1.altitude_terrain = packet_in.altitude_terrain;
- packet1.bottom_clearance = packet_in.bottom_clearance;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ALTITUDE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ALTITUDE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_altitude_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_altitude_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_altitude_pack(system_id, component_id, &msg , packet1.time_usec , packet1.altitude_monotonic , packet1.altitude_amsl , packet1.altitude_local , packet1.altitude_relative , packet1.altitude_terrain , packet1.bottom_clearance );
- mavlink_msg_altitude_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_altitude_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.altitude_monotonic , packet1.altitude_amsl , packet1.altitude_local , packet1.altitude_relative , packet1.altitude_terrain , packet1.bottom_clearance );
- mavlink_msg_altitude_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_altitude_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_altitude_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.altitude_monotonic , packet1.altitude_amsl , packet1.altitude_local , packet1.altitude_relative , packet1.altitude_terrain , packet1.bottom_clearance );
- mavlink_msg_altitude_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ALTITUDE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ALTITUDE) != NULL);
- #endif
- }
- static void mavlink_test_resource_request(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_RESOURCE_REQUEST >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_resource_request_t packet_in = {
- 5,72,{ 139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154, 155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166, 167, 168, 169, 170, 171, 172, 173, 174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184, 185, 186, 187, 188, 189, 190, 191, 192, 193, 194, 195, 196, 197, 198, 199, 200, 201, 202, 203, 204, 205, 206, 207, 208, 209, 210, 211, 212, 213, 214, 215, 216, 217, 218, 219, 220, 221, 222, 223, 224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238, 239, 240, 241, 242, 243, 244, 245, 246, 247, 248, 249, 250, 251, 252, 253, 254, 255, 0, 1, 2 },243,{ 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78, 79, 80, 81, 82, 83, 84, 85, 86, 87, 88, 89, 90, 91, 92, 93, 94, 95, 96, 97, 98, 99, 100, 101, 102, 103, 104, 105, 106, 107, 108, 109, 110, 111, 112, 113, 114, 115, 116, 117, 118, 119, 120, 121, 122, 123, 124, 125, 126, 127, 128, 129, 130, 131, 132, 133, 134, 135, 136, 137, 138, 139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154, 155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166, 167, 168, 169, 170, 171, 172, 173 }
- };
- mavlink_resource_request_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.request_id = packet_in.request_id;
- packet1.uri_type = packet_in.uri_type;
- packet1.transfer_type = packet_in.transfer_type;
-
- mav_array_memcpy(packet1.uri, packet_in.uri, sizeof(uint8_t)*120);
- mav_array_memcpy(packet1.storage, packet_in.storage, sizeof(uint8_t)*120);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_RESOURCE_REQUEST_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_RESOURCE_REQUEST_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_resource_request_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_resource_request_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_resource_request_pack(system_id, component_id, &msg , packet1.request_id , packet1.uri_type , packet1.uri , packet1.transfer_type , packet1.storage );
- mavlink_msg_resource_request_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_resource_request_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.request_id , packet1.uri_type , packet1.uri , packet1.transfer_type , packet1.storage );
- mavlink_msg_resource_request_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_resource_request_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_resource_request_send(MAVLINK_COMM_1 , packet1.request_id , packet1.uri_type , packet1.uri , packet1.transfer_type , packet1.storage );
- mavlink_msg_resource_request_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("RESOURCE_REQUEST") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_RESOURCE_REQUEST) != NULL);
- #endif
- }
- static void mavlink_test_scaled_pressure3(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SCALED_PRESSURE3 >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_scaled_pressure3_t packet_in = {
- 963497464,45.0,73.0,17859,17963
- };
- mavlink_scaled_pressure3_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.press_abs = packet_in.press_abs;
- packet1.press_diff = packet_in.press_diff;
- packet1.temperature = packet_in.temperature;
- packet1.temperature_press_diff = packet_in.temperature_press_diff;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SCALED_PRESSURE3_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SCALED_PRESSURE3_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_pressure3_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_scaled_pressure3_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_pressure3_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.press_abs , packet1.press_diff , packet1.temperature , packet1.temperature_press_diff );
- mavlink_msg_scaled_pressure3_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_pressure3_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.press_abs , packet1.press_diff , packet1.temperature , packet1.temperature_press_diff );
- mavlink_msg_scaled_pressure3_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_scaled_pressure3_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_scaled_pressure3_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.press_abs , packet1.press_diff , packet1.temperature , packet1.temperature_press_diff );
- mavlink_msg_scaled_pressure3_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SCALED_PRESSURE3") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SCALED_PRESSURE3) != NULL);
- #endif
- }
- static void mavlink_test_follow_target(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_FOLLOW_TARGET >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_follow_target_t packet_in = {
- 93372036854775807ULL,93372036854776311ULL,963498296,963498504,185.0,{ 213.0, 214.0, 215.0 },{ 297.0, 298.0, 299.0 },{ 381.0, 382.0, 383.0, 384.0 },{ 493.0, 494.0, 495.0 },{ 577.0, 578.0, 579.0 },25
- };
- mavlink_follow_target_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.timestamp = packet_in.timestamp;
- packet1.custom_state = packet_in.custom_state;
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.alt = packet_in.alt;
- packet1.est_capabilities = packet_in.est_capabilities;
-
- mav_array_memcpy(packet1.vel, packet_in.vel, sizeof(float)*3);
- mav_array_memcpy(packet1.acc, packet_in.acc, sizeof(float)*3);
- mav_array_memcpy(packet1.attitude_q, packet_in.attitude_q, sizeof(float)*4);
- mav_array_memcpy(packet1.rates, packet_in.rates, sizeof(float)*3);
- mav_array_memcpy(packet1.position_cov, packet_in.position_cov, sizeof(float)*3);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_FOLLOW_TARGET_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_FOLLOW_TARGET_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_follow_target_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_follow_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_follow_target_pack(system_id, component_id, &msg , packet1.timestamp , packet1.est_capabilities , packet1.lat , packet1.lon , packet1.alt , packet1.vel , packet1.acc , packet1.attitude_q , packet1.rates , packet1.position_cov , packet1.custom_state );
- mavlink_msg_follow_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_follow_target_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.timestamp , packet1.est_capabilities , packet1.lat , packet1.lon , packet1.alt , packet1.vel , packet1.acc , packet1.attitude_q , packet1.rates , packet1.position_cov , packet1.custom_state );
- mavlink_msg_follow_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_follow_target_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_follow_target_send(MAVLINK_COMM_1 , packet1.timestamp , packet1.est_capabilities , packet1.lat , packet1.lon , packet1.alt , packet1.vel , packet1.acc , packet1.attitude_q , packet1.rates , packet1.position_cov , packet1.custom_state );
- mavlink_msg_follow_target_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("FOLLOW_TARGET") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_FOLLOW_TARGET) != NULL);
- #endif
- }
- static void mavlink_test_control_system_state(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CONTROL_SYSTEM_STATE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_control_system_state_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,157.0,185.0,213.0,241.0,269.0,297.0,325.0,{ 353.0, 354.0, 355.0 },{ 437.0, 438.0, 439.0 },{ 521.0, 522.0, 523.0, 524.0 },633.0,661.0,689.0
- };
- mavlink_control_system_state_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.x_acc = packet_in.x_acc;
- packet1.y_acc = packet_in.y_acc;
- packet1.z_acc = packet_in.z_acc;
- packet1.x_vel = packet_in.x_vel;
- packet1.y_vel = packet_in.y_vel;
- packet1.z_vel = packet_in.z_vel;
- packet1.x_pos = packet_in.x_pos;
- packet1.y_pos = packet_in.y_pos;
- packet1.z_pos = packet_in.z_pos;
- packet1.airspeed = packet_in.airspeed;
- packet1.roll_rate = packet_in.roll_rate;
- packet1.pitch_rate = packet_in.pitch_rate;
- packet1.yaw_rate = packet_in.yaw_rate;
-
- mav_array_memcpy(packet1.vel_variance, packet_in.vel_variance, sizeof(float)*3);
- mav_array_memcpy(packet1.pos_variance, packet_in.pos_variance, sizeof(float)*3);
- mav_array_memcpy(packet1.q, packet_in.q, sizeof(float)*4);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CONTROL_SYSTEM_STATE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CONTROL_SYSTEM_STATE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_control_system_state_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_control_system_state_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_control_system_state_pack(system_id, component_id, &msg , packet1.time_usec , packet1.x_acc , packet1.y_acc , packet1.z_acc , packet1.x_vel , packet1.y_vel , packet1.z_vel , packet1.x_pos , packet1.y_pos , packet1.z_pos , packet1.airspeed , packet1.vel_variance , packet1.pos_variance , packet1.q , packet1.roll_rate , packet1.pitch_rate , packet1.yaw_rate );
- mavlink_msg_control_system_state_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_control_system_state_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.x_acc , packet1.y_acc , packet1.z_acc , packet1.x_vel , packet1.y_vel , packet1.z_vel , packet1.x_pos , packet1.y_pos , packet1.z_pos , packet1.airspeed , packet1.vel_variance , packet1.pos_variance , packet1.q , packet1.roll_rate , packet1.pitch_rate , packet1.yaw_rate );
- mavlink_msg_control_system_state_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_control_system_state_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_control_system_state_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.x_acc , packet1.y_acc , packet1.z_acc , packet1.x_vel , packet1.y_vel , packet1.z_vel , packet1.x_pos , packet1.y_pos , packet1.z_pos , packet1.airspeed , packet1.vel_variance , packet1.pos_variance , packet1.q , packet1.roll_rate , packet1.pitch_rate , packet1.yaw_rate );
- mavlink_msg_control_system_state_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CONTROL_SYSTEM_STATE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CONTROL_SYSTEM_STATE) != NULL);
- #endif
- }
- static void mavlink_test_battery_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_BATTERY_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_battery_status_t packet_in = {
- 963497464,963497672,17651,{ 17755, 17756, 17757, 17758, 17759, 17760, 17761, 17762, 17763, 17764 },18795,101,168,235,46,963499336,125,{ 19367, 19368, 19369, 19370 },216,963500064
- };
- mavlink_battery_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.current_consumed = packet_in.current_consumed;
- packet1.energy_consumed = packet_in.energy_consumed;
- packet1.temperature = packet_in.temperature;
- packet1.current_battery = packet_in.current_battery;
- packet1.id = packet_in.id;
- packet1.battery_function = packet_in.battery_function;
- packet1.type = packet_in.type;
- packet1.battery_remaining = packet_in.battery_remaining;
- packet1.time_remaining = packet_in.time_remaining;
- packet1.charge_state = packet_in.charge_state;
- packet1.mode = packet_in.mode;
- packet1.fault_bitmask = packet_in.fault_bitmask;
-
- mav_array_memcpy(packet1.voltages, packet_in.voltages, sizeof(uint16_t)*10);
- mav_array_memcpy(packet1.voltages_ext, packet_in.voltages_ext, sizeof(uint16_t)*4);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_BATTERY_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_BATTERY_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_battery_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_battery_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_battery_status_pack(system_id, component_id, &msg , packet1.id , packet1.battery_function , packet1.type , packet1.temperature , packet1.voltages , packet1.current_battery , packet1.current_consumed , packet1.energy_consumed , packet1.battery_remaining , packet1.time_remaining , packet1.charge_state , packet1.voltages_ext , packet1.mode , packet1.fault_bitmask );
- mavlink_msg_battery_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_battery_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.id , packet1.battery_function , packet1.type , packet1.temperature , packet1.voltages , packet1.current_battery , packet1.current_consumed , packet1.energy_consumed , packet1.battery_remaining , packet1.time_remaining , packet1.charge_state , packet1.voltages_ext , packet1.mode , packet1.fault_bitmask );
- mavlink_msg_battery_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_battery_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_battery_status_send(MAVLINK_COMM_1 , packet1.id , packet1.battery_function , packet1.type , packet1.temperature , packet1.voltages , packet1.current_battery , packet1.current_consumed , packet1.energy_consumed , packet1.battery_remaining , packet1.time_remaining , packet1.charge_state , packet1.voltages_ext , packet1.mode , packet1.fault_bitmask );
- mavlink_msg_battery_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("BATTERY_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_BATTERY_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_autopilot_version(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_AUTOPILOT_VERSION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_autopilot_version_t packet_in = {
- 93372036854775807ULL,93372036854776311ULL,963498296,963498504,963498712,963498920,18899,19003,{ 113, 114, 115, 116, 117, 118, 119, 120 },{ 137, 138, 139, 140, 141, 142, 143, 144 },{ 161, 162, 163, 164, 165, 166, 167, 168 },{ 185, 186, 187, 188, 189, 190, 191, 192, 193, 194, 195, 196, 197, 198, 199, 200, 201, 202 }
- };
- mavlink_autopilot_version_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.capabilities = packet_in.capabilities;
- packet1.uid = packet_in.uid;
- packet1.flight_sw_version = packet_in.flight_sw_version;
- packet1.middleware_sw_version = packet_in.middleware_sw_version;
- packet1.os_sw_version = packet_in.os_sw_version;
- packet1.board_version = packet_in.board_version;
- packet1.vendor_id = packet_in.vendor_id;
- packet1.product_id = packet_in.product_id;
-
- mav_array_memcpy(packet1.flight_custom_version, packet_in.flight_custom_version, sizeof(uint8_t)*8);
- mav_array_memcpy(packet1.middleware_custom_version, packet_in.middleware_custom_version, sizeof(uint8_t)*8);
- mav_array_memcpy(packet1.os_custom_version, packet_in.os_custom_version, sizeof(uint8_t)*8);
- mav_array_memcpy(packet1.uid2, packet_in.uid2, sizeof(uint8_t)*18);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_AUTOPILOT_VERSION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_AUTOPILOT_VERSION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_autopilot_version_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_autopilot_version_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_autopilot_version_pack(system_id, component_id, &msg , packet1.capabilities , packet1.flight_sw_version , packet1.middleware_sw_version , packet1.os_sw_version , packet1.board_version , packet1.flight_custom_version , packet1.middleware_custom_version , packet1.os_custom_version , packet1.vendor_id , packet1.product_id , packet1.uid , packet1.uid2 );
- mavlink_msg_autopilot_version_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_autopilot_version_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.capabilities , packet1.flight_sw_version , packet1.middleware_sw_version , packet1.os_sw_version , packet1.board_version , packet1.flight_custom_version , packet1.middleware_custom_version , packet1.os_custom_version , packet1.vendor_id , packet1.product_id , packet1.uid , packet1.uid2 );
- mavlink_msg_autopilot_version_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_autopilot_version_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_autopilot_version_send(MAVLINK_COMM_1 , packet1.capabilities , packet1.flight_sw_version , packet1.middleware_sw_version , packet1.os_sw_version , packet1.board_version , packet1.flight_custom_version , packet1.middleware_custom_version , packet1.os_custom_version , packet1.vendor_id , packet1.product_id , packet1.uid , packet1.uid2 );
- mavlink_msg_autopilot_version_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("AUTOPILOT_VERSION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_AUTOPILOT_VERSION) != NULL);
- #endif
- }
- static void mavlink_test_landing_target(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_LANDING_TARGET >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_landing_target_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,157.0,185.0,89,156,227.0,255.0,283.0,{ 311.0, 312.0, 313.0, 314.0 },51,118
- };
- mavlink_landing_target_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.angle_x = packet_in.angle_x;
- packet1.angle_y = packet_in.angle_y;
- packet1.distance = packet_in.distance;
- packet1.size_x = packet_in.size_x;
- packet1.size_y = packet_in.size_y;
- packet1.target_num = packet_in.target_num;
- packet1.frame = packet_in.frame;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.type = packet_in.type;
- packet1.position_valid = packet_in.position_valid;
-
- mav_array_memcpy(packet1.q, packet_in.q, sizeof(float)*4);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_LANDING_TARGET_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_LANDING_TARGET_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_landing_target_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_landing_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_landing_target_pack(system_id, component_id, &msg , packet1.time_usec , packet1.target_num , packet1.frame , packet1.angle_x , packet1.angle_y , packet1.distance , packet1.size_x , packet1.size_y , packet1.x , packet1.y , packet1.z , packet1.q , packet1.type , packet1.position_valid );
- mavlink_msg_landing_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_landing_target_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.target_num , packet1.frame , packet1.angle_x , packet1.angle_y , packet1.distance , packet1.size_x , packet1.size_y , packet1.x , packet1.y , packet1.z , packet1.q , packet1.type , packet1.position_valid );
- mavlink_msg_landing_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_landing_target_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_landing_target_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.target_num , packet1.frame , packet1.angle_x , packet1.angle_y , packet1.distance , packet1.size_x , packet1.size_y , packet1.x , packet1.y , packet1.z , packet1.q , packet1.type , packet1.position_valid );
- mavlink_msg_landing_target_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("LANDING_TARGET") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_LANDING_TARGET) != NULL);
- #endif
- }
- static void mavlink_test_fence_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_FENCE_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_fence_status_t packet_in = {
- 963497464,17443,151,218,29
- };
- mavlink_fence_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.breach_time = packet_in.breach_time;
- packet1.breach_count = packet_in.breach_count;
- packet1.breach_status = packet_in.breach_status;
- packet1.breach_type = packet_in.breach_type;
- packet1.breach_mitigation = packet_in.breach_mitigation;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_FENCE_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_FENCE_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_fence_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_fence_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_fence_status_pack(system_id, component_id, &msg , packet1.breach_status , packet1.breach_count , packet1.breach_type , packet1.breach_time , packet1.breach_mitigation );
- mavlink_msg_fence_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_fence_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.breach_status , packet1.breach_count , packet1.breach_type , packet1.breach_time , packet1.breach_mitigation );
- mavlink_msg_fence_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_fence_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_fence_status_send(MAVLINK_COMM_1 , packet1.breach_status , packet1.breach_count , packet1.breach_type , packet1.breach_time , packet1.breach_mitigation );
- mavlink_msg_fence_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("FENCE_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_FENCE_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_mag_cal_report(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MAG_CAL_REPORT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_mag_cal_report_t packet_in = {
- 17.0,45.0,73.0,101.0,129.0,157.0,185.0,213.0,241.0,269.0,125,192,3,70,325.0,149,216,367.0
- };
- mavlink_mag_cal_report_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.fitness = packet_in.fitness;
- packet1.ofs_x = packet_in.ofs_x;
- packet1.ofs_y = packet_in.ofs_y;
- packet1.ofs_z = packet_in.ofs_z;
- packet1.diag_x = packet_in.diag_x;
- packet1.diag_y = packet_in.diag_y;
- packet1.diag_z = packet_in.diag_z;
- packet1.offdiag_x = packet_in.offdiag_x;
- packet1.offdiag_y = packet_in.offdiag_y;
- packet1.offdiag_z = packet_in.offdiag_z;
- packet1.compass_id = packet_in.compass_id;
- packet1.cal_mask = packet_in.cal_mask;
- packet1.cal_status = packet_in.cal_status;
- packet1.autosaved = packet_in.autosaved;
- packet1.orientation_confidence = packet_in.orientation_confidence;
- packet1.old_orientation = packet_in.old_orientation;
- packet1.new_orientation = packet_in.new_orientation;
- packet1.scale_factor = packet_in.scale_factor;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MAG_CAL_REPORT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MAG_CAL_REPORT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mag_cal_report_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_mag_cal_report_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mag_cal_report_pack(system_id, component_id, &msg , packet1.compass_id , packet1.cal_mask , packet1.cal_status , packet1.autosaved , packet1.fitness , packet1.ofs_x , packet1.ofs_y , packet1.ofs_z , packet1.diag_x , packet1.diag_y , packet1.diag_z , packet1.offdiag_x , packet1.offdiag_y , packet1.offdiag_z , packet1.orientation_confidence , packet1.old_orientation , packet1.new_orientation , packet1.scale_factor );
- mavlink_msg_mag_cal_report_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mag_cal_report_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.compass_id , packet1.cal_mask , packet1.cal_status , packet1.autosaved , packet1.fitness , packet1.ofs_x , packet1.ofs_y , packet1.ofs_z , packet1.diag_x , packet1.diag_y , packet1.diag_z , packet1.offdiag_x , packet1.offdiag_y , packet1.offdiag_z , packet1.orientation_confidence , packet1.old_orientation , packet1.new_orientation , packet1.scale_factor );
- mavlink_msg_mag_cal_report_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_mag_cal_report_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mag_cal_report_send(MAVLINK_COMM_1 , packet1.compass_id , packet1.cal_mask , packet1.cal_status , packet1.autosaved , packet1.fitness , packet1.ofs_x , packet1.ofs_y , packet1.ofs_z , packet1.diag_x , packet1.diag_y , packet1.diag_z , packet1.offdiag_x , packet1.offdiag_y , packet1.offdiag_z , packet1.orientation_confidence , packet1.old_orientation , packet1.new_orientation , packet1.scale_factor );
- mavlink_msg_mag_cal_report_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MAG_CAL_REPORT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MAG_CAL_REPORT) != NULL);
- #endif
- }
- static void mavlink_test_efi_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_EFI_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_efi_status_t packet_in = {
- 17.0,45.0,73.0,101.0,129.0,157.0,185.0,213.0,241.0,269.0,297.0,325.0,353.0,381.0,409.0,437.0,197,472.0,500.0
- };
- mavlink_efi_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.ecu_index = packet_in.ecu_index;
- packet1.rpm = packet_in.rpm;
- packet1.fuel_consumed = packet_in.fuel_consumed;
- packet1.fuel_flow = packet_in.fuel_flow;
- packet1.engine_load = packet_in.engine_load;
- packet1.throttle_position = packet_in.throttle_position;
- packet1.spark_dwell_time = packet_in.spark_dwell_time;
- packet1.barometric_pressure = packet_in.barometric_pressure;
- packet1.intake_manifold_pressure = packet_in.intake_manifold_pressure;
- packet1.intake_manifold_temperature = packet_in.intake_manifold_temperature;
- packet1.cylinder_head_temperature = packet_in.cylinder_head_temperature;
- packet1.ignition_timing = packet_in.ignition_timing;
- packet1.injection_time = packet_in.injection_time;
- packet1.exhaust_gas_temperature = packet_in.exhaust_gas_temperature;
- packet1.throttle_out = packet_in.throttle_out;
- packet1.pt_compensation = packet_in.pt_compensation;
- packet1.health = packet_in.health;
- packet1.ignition_voltage = packet_in.ignition_voltage;
- packet1.fuel_pressure = packet_in.fuel_pressure;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_EFI_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_EFI_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_efi_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_efi_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_efi_status_pack(system_id, component_id, &msg , packet1.health , packet1.ecu_index , packet1.rpm , packet1.fuel_consumed , packet1.fuel_flow , packet1.engine_load , packet1.throttle_position , packet1.spark_dwell_time , packet1.barometric_pressure , packet1.intake_manifold_pressure , packet1.intake_manifold_temperature , packet1.cylinder_head_temperature , packet1.ignition_timing , packet1.injection_time , packet1.exhaust_gas_temperature , packet1.throttle_out , packet1.pt_compensation , packet1.ignition_voltage , packet1.fuel_pressure );
- mavlink_msg_efi_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_efi_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.health , packet1.ecu_index , packet1.rpm , packet1.fuel_consumed , packet1.fuel_flow , packet1.engine_load , packet1.throttle_position , packet1.spark_dwell_time , packet1.barometric_pressure , packet1.intake_manifold_pressure , packet1.intake_manifold_temperature , packet1.cylinder_head_temperature , packet1.ignition_timing , packet1.injection_time , packet1.exhaust_gas_temperature , packet1.throttle_out , packet1.pt_compensation , packet1.ignition_voltage , packet1.fuel_pressure );
- mavlink_msg_efi_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_efi_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_efi_status_send(MAVLINK_COMM_1 , packet1.health , packet1.ecu_index , packet1.rpm , packet1.fuel_consumed , packet1.fuel_flow , packet1.engine_load , packet1.throttle_position , packet1.spark_dwell_time , packet1.barometric_pressure , packet1.intake_manifold_pressure , packet1.intake_manifold_temperature , packet1.cylinder_head_temperature , packet1.ignition_timing , packet1.injection_time , packet1.exhaust_gas_temperature , packet1.throttle_out , packet1.pt_compensation , packet1.ignition_voltage , packet1.fuel_pressure );
- mavlink_msg_efi_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("EFI_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_EFI_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_estimator_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ESTIMATOR_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_estimator_status_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,157.0,185.0,213.0,241.0,269.0,19315
- };
- mavlink_estimator_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.vel_ratio = packet_in.vel_ratio;
- packet1.pos_horiz_ratio = packet_in.pos_horiz_ratio;
- packet1.pos_vert_ratio = packet_in.pos_vert_ratio;
- packet1.mag_ratio = packet_in.mag_ratio;
- packet1.hagl_ratio = packet_in.hagl_ratio;
- packet1.tas_ratio = packet_in.tas_ratio;
- packet1.pos_horiz_accuracy = packet_in.pos_horiz_accuracy;
- packet1.pos_vert_accuracy = packet_in.pos_vert_accuracy;
- packet1.flags = packet_in.flags;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ESTIMATOR_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ESTIMATOR_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_estimator_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_estimator_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_estimator_status_pack(system_id, component_id, &msg , packet1.time_usec , packet1.flags , packet1.vel_ratio , packet1.pos_horiz_ratio , packet1.pos_vert_ratio , packet1.mag_ratio , packet1.hagl_ratio , packet1.tas_ratio , packet1.pos_horiz_accuracy , packet1.pos_vert_accuracy );
- mavlink_msg_estimator_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_estimator_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.flags , packet1.vel_ratio , packet1.pos_horiz_ratio , packet1.pos_vert_ratio , packet1.mag_ratio , packet1.hagl_ratio , packet1.tas_ratio , packet1.pos_horiz_accuracy , packet1.pos_vert_accuracy );
- mavlink_msg_estimator_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_estimator_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_estimator_status_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.flags , packet1.vel_ratio , packet1.pos_horiz_ratio , packet1.pos_vert_ratio , packet1.mag_ratio , packet1.hagl_ratio , packet1.tas_ratio , packet1.pos_horiz_accuracy , packet1.pos_vert_accuracy );
- mavlink_msg_estimator_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ESTIMATOR_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ESTIMATOR_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_wind_cov(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_WIND_COV >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_wind_cov_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,157.0,185.0,213.0,241.0,269.0
- };
- mavlink_wind_cov_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.wind_x = packet_in.wind_x;
- packet1.wind_y = packet_in.wind_y;
- packet1.wind_z = packet_in.wind_z;
- packet1.var_horiz = packet_in.var_horiz;
- packet1.var_vert = packet_in.var_vert;
- packet1.wind_alt = packet_in.wind_alt;
- packet1.horiz_accuracy = packet_in.horiz_accuracy;
- packet1.vert_accuracy = packet_in.vert_accuracy;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_WIND_COV_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_WIND_COV_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_wind_cov_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_wind_cov_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_wind_cov_pack(system_id, component_id, &msg , packet1.time_usec , packet1.wind_x , packet1.wind_y , packet1.wind_z , packet1.var_horiz , packet1.var_vert , packet1.wind_alt , packet1.horiz_accuracy , packet1.vert_accuracy );
- mavlink_msg_wind_cov_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_wind_cov_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.wind_x , packet1.wind_y , packet1.wind_z , packet1.var_horiz , packet1.var_vert , packet1.wind_alt , packet1.horiz_accuracy , packet1.vert_accuracy );
- mavlink_msg_wind_cov_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_wind_cov_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_wind_cov_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.wind_x , packet1.wind_y , packet1.wind_z , packet1.var_horiz , packet1.var_vert , packet1.wind_alt , packet1.horiz_accuracy , packet1.vert_accuracy );
- mavlink_msg_wind_cov_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("WIND_COV") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_WIND_COV) != NULL);
- #endif
- }
- static void mavlink_test_gps_input(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GPS_INPUT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gps_input_t packet_in = {
- 93372036854775807ULL,963497880,963498088,963498296,157.0,185.0,213.0,241.0,269.0,297.0,325.0,353.0,381.0,20147,20251,185,252,63,20511
- };
- mavlink_gps_input_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.time_week_ms = packet_in.time_week_ms;
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.alt = packet_in.alt;
- packet1.hdop = packet_in.hdop;
- packet1.vdop = packet_in.vdop;
- packet1.vn = packet_in.vn;
- packet1.ve = packet_in.ve;
- packet1.vd = packet_in.vd;
- packet1.speed_accuracy = packet_in.speed_accuracy;
- packet1.horiz_accuracy = packet_in.horiz_accuracy;
- packet1.vert_accuracy = packet_in.vert_accuracy;
- packet1.ignore_flags = packet_in.ignore_flags;
- packet1.time_week = packet_in.time_week;
- packet1.gps_id = packet_in.gps_id;
- packet1.fix_type = packet_in.fix_type;
- packet1.satellites_visible = packet_in.satellites_visible;
- packet1.yaw = packet_in.yaw;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GPS_INPUT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GPS_INPUT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_input_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gps_input_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_input_pack(system_id, component_id, &msg , packet1.time_usec , packet1.gps_id , packet1.ignore_flags , packet1.time_week_ms , packet1.time_week , packet1.fix_type , packet1.lat , packet1.lon , packet1.alt , packet1.hdop , packet1.vdop , packet1.vn , packet1.ve , packet1.vd , packet1.speed_accuracy , packet1.horiz_accuracy , packet1.vert_accuracy , packet1.satellites_visible , packet1.yaw );
- mavlink_msg_gps_input_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_input_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.gps_id , packet1.ignore_flags , packet1.time_week_ms , packet1.time_week , packet1.fix_type , packet1.lat , packet1.lon , packet1.alt , packet1.hdop , packet1.vdop , packet1.vn , packet1.ve , packet1.vd , packet1.speed_accuracy , packet1.horiz_accuracy , packet1.vert_accuracy , packet1.satellites_visible , packet1.yaw );
- mavlink_msg_gps_input_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gps_input_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_input_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.gps_id , packet1.ignore_flags , packet1.time_week_ms , packet1.time_week , packet1.fix_type , packet1.lat , packet1.lon , packet1.alt , packet1.hdop , packet1.vdop , packet1.vn , packet1.ve , packet1.vd , packet1.speed_accuracy , packet1.horiz_accuracy , packet1.vert_accuracy , packet1.satellites_visible , packet1.yaw );
- mavlink_msg_gps_input_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GPS_INPUT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GPS_INPUT) != NULL);
- #endif
- }
- static void mavlink_test_gps_rtcm_data(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GPS_RTCM_DATA >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gps_rtcm_data_t packet_in = {
- 5,72,{ 139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154, 155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166, 167, 168, 169, 170, 171, 172, 173, 174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184, 185, 186, 187, 188, 189, 190, 191, 192, 193, 194, 195, 196, 197, 198, 199, 200, 201, 202, 203, 204, 205, 206, 207, 208, 209, 210, 211, 212, 213, 214, 215, 216, 217, 218, 219, 220, 221, 222, 223, 224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238, 239, 240, 241, 242, 243, 244, 245, 246, 247, 248, 249, 250, 251, 252, 253, 254, 255, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62 }
- };
- mavlink_gps_rtcm_data_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.flags = packet_in.flags;
- packet1.len = packet_in.len;
-
- mav_array_memcpy(packet1.data, packet_in.data, sizeof(uint8_t)*180);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GPS_RTCM_DATA_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GPS_RTCM_DATA_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_rtcm_data_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gps_rtcm_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_rtcm_data_pack(system_id, component_id, &msg , packet1.flags , packet1.len , packet1.data );
- mavlink_msg_gps_rtcm_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_rtcm_data_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.flags , packet1.len , packet1.data );
- mavlink_msg_gps_rtcm_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gps_rtcm_data_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gps_rtcm_data_send(MAVLINK_COMM_1 , packet1.flags , packet1.len , packet1.data );
- mavlink_msg_gps_rtcm_data_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GPS_RTCM_DATA") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GPS_RTCM_DATA) != NULL);
- #endif
- }
- static void mavlink_test_high_latency(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_HIGH_LATENCY >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_high_latency_t packet_in = {
- 963497464,963497672,963497880,17859,17963,18067,18171,18275,18379,18483,211,22,89,156,223,34,101,168,235,46,113,180,247,58
- };
- mavlink_high_latency_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.custom_mode = packet_in.custom_mode;
- packet1.latitude = packet_in.latitude;
- packet1.longitude = packet_in.longitude;
- packet1.roll = packet_in.roll;
- packet1.pitch = packet_in.pitch;
- packet1.heading = packet_in.heading;
- packet1.heading_sp = packet_in.heading_sp;
- packet1.altitude_amsl = packet_in.altitude_amsl;
- packet1.altitude_sp = packet_in.altitude_sp;
- packet1.wp_distance = packet_in.wp_distance;
- packet1.base_mode = packet_in.base_mode;
- packet1.landed_state = packet_in.landed_state;
- packet1.throttle = packet_in.throttle;
- packet1.airspeed = packet_in.airspeed;
- packet1.airspeed_sp = packet_in.airspeed_sp;
- packet1.groundspeed = packet_in.groundspeed;
- packet1.climb_rate = packet_in.climb_rate;
- packet1.gps_nsat = packet_in.gps_nsat;
- packet1.gps_fix_type = packet_in.gps_fix_type;
- packet1.battery_remaining = packet_in.battery_remaining;
- packet1.temperature = packet_in.temperature;
- packet1.temperature_air = packet_in.temperature_air;
- packet1.failsafe = packet_in.failsafe;
- packet1.wp_num = packet_in.wp_num;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_HIGH_LATENCY_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_HIGH_LATENCY_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_high_latency_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_high_latency_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_high_latency_pack(system_id, component_id, &msg , packet1.base_mode , packet1.custom_mode , packet1.landed_state , packet1.roll , packet1.pitch , packet1.heading , packet1.throttle , packet1.heading_sp , packet1.latitude , packet1.longitude , packet1.altitude_amsl , packet1.altitude_sp , packet1.airspeed , packet1.airspeed_sp , packet1.groundspeed , packet1.climb_rate , packet1.gps_nsat , packet1.gps_fix_type , packet1.battery_remaining , packet1.temperature , packet1.temperature_air , packet1.failsafe , packet1.wp_num , packet1.wp_distance );
- mavlink_msg_high_latency_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_high_latency_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.base_mode , packet1.custom_mode , packet1.landed_state , packet1.roll , packet1.pitch , packet1.heading , packet1.throttle , packet1.heading_sp , packet1.latitude , packet1.longitude , packet1.altitude_amsl , packet1.altitude_sp , packet1.airspeed , packet1.airspeed_sp , packet1.groundspeed , packet1.climb_rate , packet1.gps_nsat , packet1.gps_fix_type , packet1.battery_remaining , packet1.temperature , packet1.temperature_air , packet1.failsafe , packet1.wp_num , packet1.wp_distance );
- mavlink_msg_high_latency_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_high_latency_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_high_latency_send(MAVLINK_COMM_1 , packet1.base_mode , packet1.custom_mode , packet1.landed_state , packet1.roll , packet1.pitch , packet1.heading , packet1.throttle , packet1.heading_sp , packet1.latitude , packet1.longitude , packet1.altitude_amsl , packet1.altitude_sp , packet1.airspeed , packet1.airspeed_sp , packet1.groundspeed , packet1.climb_rate , packet1.gps_nsat , packet1.gps_fix_type , packet1.battery_remaining , packet1.temperature , packet1.temperature_air , packet1.failsafe , packet1.wp_num , packet1.wp_distance );
- mavlink_msg_high_latency_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("HIGH_LATENCY") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_HIGH_LATENCY) != NULL);
- #endif
- }
- static void mavlink_test_high_latency2(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_HIGH_LATENCY2 >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_high_latency2_t packet_in = {
- 963497464,963497672,963497880,17859,17963,18067,18171,18275,18379,77,144,211,22,89,156,223,34,101,168,235,46,113,180,247,58,125,192
- };
- mavlink_high_latency2_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.timestamp = packet_in.timestamp;
- packet1.latitude = packet_in.latitude;
- packet1.longitude = packet_in.longitude;
- packet1.custom_mode = packet_in.custom_mode;
- packet1.altitude = packet_in.altitude;
- packet1.target_altitude = packet_in.target_altitude;
- packet1.target_distance = packet_in.target_distance;
- packet1.wp_num = packet_in.wp_num;
- packet1.failure_flags = packet_in.failure_flags;
- packet1.type = packet_in.type;
- packet1.autopilot = packet_in.autopilot;
- packet1.heading = packet_in.heading;
- packet1.target_heading = packet_in.target_heading;
- packet1.throttle = packet_in.throttle;
- packet1.airspeed = packet_in.airspeed;
- packet1.airspeed_sp = packet_in.airspeed_sp;
- packet1.groundspeed = packet_in.groundspeed;
- packet1.windspeed = packet_in.windspeed;
- packet1.wind_heading = packet_in.wind_heading;
- packet1.eph = packet_in.eph;
- packet1.epv = packet_in.epv;
- packet1.temperature_air = packet_in.temperature_air;
- packet1.climb_rate = packet_in.climb_rate;
- packet1.battery = packet_in.battery;
- packet1.custom0 = packet_in.custom0;
- packet1.custom1 = packet_in.custom1;
- packet1.custom2 = packet_in.custom2;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_HIGH_LATENCY2_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_HIGH_LATENCY2_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_high_latency2_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_high_latency2_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_high_latency2_pack(system_id, component_id, &msg , packet1.timestamp , packet1.type , packet1.autopilot , packet1.custom_mode , packet1.latitude , packet1.longitude , packet1.altitude , packet1.target_altitude , packet1.heading , packet1.target_heading , packet1.target_distance , packet1.throttle , packet1.airspeed , packet1.airspeed_sp , packet1.groundspeed , packet1.windspeed , packet1.wind_heading , packet1.eph , packet1.epv , packet1.temperature_air , packet1.climb_rate , packet1.battery , packet1.wp_num , packet1.failure_flags , packet1.custom0 , packet1.custom1 , packet1.custom2 );
- mavlink_msg_high_latency2_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_high_latency2_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.timestamp , packet1.type , packet1.autopilot , packet1.custom_mode , packet1.latitude , packet1.longitude , packet1.altitude , packet1.target_altitude , packet1.heading , packet1.target_heading , packet1.target_distance , packet1.throttle , packet1.airspeed , packet1.airspeed_sp , packet1.groundspeed , packet1.windspeed , packet1.wind_heading , packet1.eph , packet1.epv , packet1.temperature_air , packet1.climb_rate , packet1.battery , packet1.wp_num , packet1.failure_flags , packet1.custom0 , packet1.custom1 , packet1.custom2 );
- mavlink_msg_high_latency2_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_high_latency2_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_high_latency2_send(MAVLINK_COMM_1 , packet1.timestamp , packet1.type , packet1.autopilot , packet1.custom_mode , packet1.latitude , packet1.longitude , packet1.altitude , packet1.target_altitude , packet1.heading , packet1.target_heading , packet1.target_distance , packet1.throttle , packet1.airspeed , packet1.airspeed_sp , packet1.groundspeed , packet1.windspeed , packet1.wind_heading , packet1.eph , packet1.epv , packet1.temperature_air , packet1.climb_rate , packet1.battery , packet1.wp_num , packet1.failure_flags , packet1.custom0 , packet1.custom1 , packet1.custom2 );
- mavlink_msg_high_latency2_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("HIGH_LATENCY2") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_HIGH_LATENCY2) != NULL);
- #endif
- }
- static void mavlink_test_vibration(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_VIBRATION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_vibration_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,963498504,963498712,963498920
- };
- mavlink_vibration_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.vibration_x = packet_in.vibration_x;
- packet1.vibration_y = packet_in.vibration_y;
- packet1.vibration_z = packet_in.vibration_z;
- packet1.clipping_0 = packet_in.clipping_0;
- packet1.clipping_1 = packet_in.clipping_1;
- packet1.clipping_2 = packet_in.clipping_2;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_VIBRATION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_VIBRATION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vibration_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_vibration_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vibration_pack(system_id, component_id, &msg , packet1.time_usec , packet1.vibration_x , packet1.vibration_y , packet1.vibration_z , packet1.clipping_0 , packet1.clipping_1 , packet1.clipping_2 );
- mavlink_msg_vibration_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vibration_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.vibration_x , packet1.vibration_y , packet1.vibration_z , packet1.clipping_0 , packet1.clipping_1 , packet1.clipping_2 );
- mavlink_msg_vibration_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_vibration_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_vibration_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.vibration_x , packet1.vibration_y , packet1.vibration_z , packet1.clipping_0 , packet1.clipping_1 , packet1.clipping_2 );
- mavlink_msg_vibration_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("VIBRATION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_VIBRATION) != NULL);
- #endif
- }
- static void mavlink_test_home_position(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_HOME_POSITION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_home_position_t packet_in = {
- 963497464,963497672,963497880,101.0,129.0,157.0,{ 185.0, 186.0, 187.0, 188.0 },297.0,325.0,353.0,93372036854779083ULL
- };
- mavlink_home_position_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.latitude = packet_in.latitude;
- packet1.longitude = packet_in.longitude;
- packet1.altitude = packet_in.altitude;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.approach_x = packet_in.approach_x;
- packet1.approach_y = packet_in.approach_y;
- packet1.approach_z = packet_in.approach_z;
- packet1.time_usec = packet_in.time_usec;
-
- mav_array_memcpy(packet1.q, packet_in.q, sizeof(float)*4);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_HOME_POSITION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_HOME_POSITION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_home_position_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_home_position_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_home_position_pack(system_id, component_id, &msg , packet1.latitude , packet1.longitude , packet1.altitude , packet1.x , packet1.y , packet1.z , packet1.q , packet1.approach_x , packet1.approach_y , packet1.approach_z , packet1.time_usec );
- mavlink_msg_home_position_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_home_position_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.latitude , packet1.longitude , packet1.altitude , packet1.x , packet1.y , packet1.z , packet1.q , packet1.approach_x , packet1.approach_y , packet1.approach_z , packet1.time_usec );
- mavlink_msg_home_position_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_home_position_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_home_position_send(MAVLINK_COMM_1 , packet1.latitude , packet1.longitude , packet1.altitude , packet1.x , packet1.y , packet1.z , packet1.q , packet1.approach_x , packet1.approach_y , packet1.approach_z , packet1.time_usec );
- mavlink_msg_home_position_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("HOME_POSITION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_HOME_POSITION) != NULL);
- #endif
- }
- static void mavlink_test_set_home_position(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SET_HOME_POSITION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_set_home_position_t packet_in = {
- 963497464,963497672,963497880,101.0,129.0,157.0,{ 185.0, 186.0, 187.0, 188.0 },297.0,325.0,353.0,161,93372036854779146ULL
- };
- mavlink_set_home_position_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.latitude = packet_in.latitude;
- packet1.longitude = packet_in.longitude;
- packet1.altitude = packet_in.altitude;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.approach_x = packet_in.approach_x;
- packet1.approach_y = packet_in.approach_y;
- packet1.approach_z = packet_in.approach_z;
- packet1.target_system = packet_in.target_system;
- packet1.time_usec = packet_in.time_usec;
-
- mav_array_memcpy(packet1.q, packet_in.q, sizeof(float)*4);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SET_HOME_POSITION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SET_HOME_POSITION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_home_position_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_set_home_position_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_home_position_pack(system_id, component_id, &msg , packet1.target_system , packet1.latitude , packet1.longitude , packet1.altitude , packet1.x , packet1.y , packet1.z , packet1.q , packet1.approach_x , packet1.approach_y , packet1.approach_z , packet1.time_usec );
- mavlink_msg_set_home_position_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_home_position_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.latitude , packet1.longitude , packet1.altitude , packet1.x , packet1.y , packet1.z , packet1.q , packet1.approach_x , packet1.approach_y , packet1.approach_z , packet1.time_usec );
- mavlink_msg_set_home_position_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_set_home_position_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_set_home_position_send(MAVLINK_COMM_1 , packet1.target_system , packet1.latitude , packet1.longitude , packet1.altitude , packet1.x , packet1.y , packet1.z , packet1.q , packet1.approach_x , packet1.approach_y , packet1.approach_z , packet1.time_usec );
- mavlink_msg_set_home_position_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SET_HOME_POSITION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SET_HOME_POSITION) != NULL);
- #endif
- }
- static void mavlink_test_message_interval(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MESSAGE_INTERVAL >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_message_interval_t packet_in = {
- 963497464,17443
- };
- mavlink_message_interval_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.interval_us = packet_in.interval_us;
- packet1.message_id = packet_in.message_id;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MESSAGE_INTERVAL_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MESSAGE_INTERVAL_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_message_interval_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_message_interval_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_message_interval_pack(system_id, component_id, &msg , packet1.message_id , packet1.interval_us );
- mavlink_msg_message_interval_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_message_interval_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.message_id , packet1.interval_us );
- mavlink_msg_message_interval_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_message_interval_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_message_interval_send(MAVLINK_COMM_1 , packet1.message_id , packet1.interval_us );
- mavlink_msg_message_interval_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MESSAGE_INTERVAL") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MESSAGE_INTERVAL) != NULL);
- #endif
- }
- static void mavlink_test_extended_sys_state(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_EXTENDED_SYS_STATE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_extended_sys_state_t packet_in = {
- 5,72
- };
- mavlink_extended_sys_state_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.vtol_state = packet_in.vtol_state;
- packet1.landed_state = packet_in.landed_state;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_EXTENDED_SYS_STATE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_EXTENDED_SYS_STATE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_extended_sys_state_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_extended_sys_state_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_extended_sys_state_pack(system_id, component_id, &msg , packet1.vtol_state , packet1.landed_state );
- mavlink_msg_extended_sys_state_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_extended_sys_state_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.vtol_state , packet1.landed_state );
- mavlink_msg_extended_sys_state_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_extended_sys_state_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_extended_sys_state_send(MAVLINK_COMM_1 , packet1.vtol_state , packet1.landed_state );
- mavlink_msg_extended_sys_state_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("EXTENDED_SYS_STATE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_EXTENDED_SYS_STATE) != NULL);
- #endif
- }
- static void mavlink_test_adsb_vehicle(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ADSB_VEHICLE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_adsb_vehicle_t packet_in = {
- 963497464,963497672,963497880,963498088,18067,18171,18275,18379,18483,211,"BCDEFGHI",113,180
- };
- mavlink_adsb_vehicle_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.ICAO_address = packet_in.ICAO_address;
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.altitude = packet_in.altitude;
- packet1.heading = packet_in.heading;
- packet1.hor_velocity = packet_in.hor_velocity;
- packet1.ver_velocity = packet_in.ver_velocity;
- packet1.flags = packet_in.flags;
- packet1.squawk = packet_in.squawk;
- packet1.altitude_type = packet_in.altitude_type;
- packet1.emitter_type = packet_in.emitter_type;
- packet1.tslc = packet_in.tslc;
-
- mav_array_memcpy(packet1.callsign, packet_in.callsign, sizeof(char)*9);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ADSB_VEHICLE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ADSB_VEHICLE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_adsb_vehicle_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_adsb_vehicle_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_adsb_vehicle_pack(system_id, component_id, &msg , packet1.ICAO_address , packet1.lat , packet1.lon , packet1.altitude_type , packet1.altitude , packet1.heading , packet1.hor_velocity , packet1.ver_velocity , packet1.callsign , packet1.emitter_type , packet1.tslc , packet1.flags , packet1.squawk );
- mavlink_msg_adsb_vehicle_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_adsb_vehicle_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.ICAO_address , packet1.lat , packet1.lon , packet1.altitude_type , packet1.altitude , packet1.heading , packet1.hor_velocity , packet1.ver_velocity , packet1.callsign , packet1.emitter_type , packet1.tslc , packet1.flags , packet1.squawk );
- mavlink_msg_adsb_vehicle_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_adsb_vehicle_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_adsb_vehicle_send(MAVLINK_COMM_1 , packet1.ICAO_address , packet1.lat , packet1.lon , packet1.altitude_type , packet1.altitude , packet1.heading , packet1.hor_velocity , packet1.ver_velocity , packet1.callsign , packet1.emitter_type , packet1.tslc , packet1.flags , packet1.squawk );
- mavlink_msg_adsb_vehicle_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ADSB_VEHICLE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ADSB_VEHICLE) != NULL);
- #endif
- }
- static void mavlink_test_collision(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_COLLISION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_collision_t packet_in = {
- 963497464,45.0,73.0,101.0,53,120,187
- };
- mavlink_collision_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.id = packet_in.id;
- packet1.time_to_minimum_delta = packet_in.time_to_minimum_delta;
- packet1.altitude_minimum_delta = packet_in.altitude_minimum_delta;
- packet1.horizontal_minimum_delta = packet_in.horizontal_minimum_delta;
- packet1.src = packet_in.src;
- packet1.action = packet_in.action;
- packet1.threat_level = packet_in.threat_level;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_COLLISION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_COLLISION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_collision_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_collision_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_collision_pack(system_id, component_id, &msg , packet1.src , packet1.id , packet1.action , packet1.threat_level , packet1.time_to_minimum_delta , packet1.altitude_minimum_delta , packet1.horizontal_minimum_delta );
- mavlink_msg_collision_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_collision_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.src , packet1.id , packet1.action , packet1.threat_level , packet1.time_to_minimum_delta , packet1.altitude_minimum_delta , packet1.horizontal_minimum_delta );
- mavlink_msg_collision_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_collision_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_collision_send(MAVLINK_COMM_1 , packet1.src , packet1.id , packet1.action , packet1.threat_level , packet1.time_to_minimum_delta , packet1.altitude_minimum_delta , packet1.horizontal_minimum_delta );
- mavlink_msg_collision_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("COLLISION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_COLLISION) != NULL);
- #endif
- }
- static void mavlink_test_v2_extension(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_V2_EXTENSION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_v2_extension_t packet_in = {
- 17235,139,206,17,{ 84, 85, 86, 87, 88, 89, 90, 91, 92, 93, 94, 95, 96, 97, 98, 99, 100, 101, 102, 103, 104, 105, 106, 107, 108, 109, 110, 111, 112, 113, 114, 115, 116, 117, 118, 119, 120, 121, 122, 123, 124, 125, 126, 127, 128, 129, 130, 131, 132, 133, 134, 135, 136, 137, 138, 139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154, 155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166, 167, 168, 169, 170, 171, 172, 173, 174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184, 185, 186, 187, 188, 189, 190, 191, 192, 193, 194, 195, 196, 197, 198, 199, 200, 201, 202, 203, 204, 205, 206, 207, 208, 209, 210, 211, 212, 213, 214, 215, 216, 217, 218, 219, 220, 221, 222, 223, 224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238, 239, 240, 241, 242, 243, 244, 245, 246, 247, 248, 249, 250, 251, 252, 253, 254, 255, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76 }
- };
- mavlink_v2_extension_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.message_type = packet_in.message_type;
- packet1.target_network = packet_in.target_network;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
- mav_array_memcpy(packet1.payload, packet_in.payload, sizeof(uint8_t)*249);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_V2_EXTENSION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_V2_EXTENSION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_v2_extension_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_v2_extension_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_v2_extension_pack(system_id, component_id, &msg , packet1.target_network , packet1.target_system , packet1.target_component , packet1.message_type , packet1.payload );
- mavlink_msg_v2_extension_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_v2_extension_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_network , packet1.target_system , packet1.target_component , packet1.message_type , packet1.payload );
- mavlink_msg_v2_extension_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_v2_extension_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_v2_extension_send(MAVLINK_COMM_1 , packet1.target_network , packet1.target_system , packet1.target_component , packet1.message_type , packet1.payload );
- mavlink_msg_v2_extension_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("V2_EXTENSION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_V2_EXTENSION) != NULL);
- #endif
- }
- static void mavlink_test_memory_vect(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MEMORY_VECT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_memory_vect_t packet_in = {
- 17235,139,206,{ 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, 48 }
- };
- mavlink_memory_vect_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.address = packet_in.address;
- packet1.ver = packet_in.ver;
- packet1.type = packet_in.type;
-
- mav_array_memcpy(packet1.value, packet_in.value, sizeof(int8_t)*32);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MEMORY_VECT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MEMORY_VECT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_memory_vect_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_memory_vect_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_memory_vect_pack(system_id, component_id, &msg , packet1.address , packet1.ver , packet1.type , packet1.value );
- mavlink_msg_memory_vect_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_memory_vect_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.address , packet1.ver , packet1.type , packet1.value );
- mavlink_msg_memory_vect_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_memory_vect_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_memory_vect_send(MAVLINK_COMM_1 , packet1.address , packet1.ver , packet1.type , packet1.value );
- mavlink_msg_memory_vect_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MEMORY_VECT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MEMORY_VECT) != NULL);
- #endif
- }
- static void mavlink_test_debug_vect(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_DEBUG_VECT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_debug_vect_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,"UVWXYZABC"
- };
- mavlink_debug_vect_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
-
- mav_array_memcpy(packet1.name, packet_in.name, sizeof(char)*10);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_DEBUG_VECT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_DEBUG_VECT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_debug_vect_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_debug_vect_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_debug_vect_pack(system_id, component_id, &msg , packet1.name , packet1.time_usec , packet1.x , packet1.y , packet1.z );
- mavlink_msg_debug_vect_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_debug_vect_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.name , packet1.time_usec , packet1.x , packet1.y , packet1.z );
- mavlink_msg_debug_vect_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_debug_vect_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_debug_vect_send(MAVLINK_COMM_1 , packet1.name , packet1.time_usec , packet1.x , packet1.y , packet1.z );
- mavlink_msg_debug_vect_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("DEBUG_VECT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_DEBUG_VECT) != NULL);
- #endif
- }
- static void mavlink_test_named_value_float(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_NAMED_VALUE_FLOAT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_named_value_float_t packet_in = {
- 963497464,45.0,"IJKLMNOPQ"
- };
- mavlink_named_value_float_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.value = packet_in.value;
-
- mav_array_memcpy(packet1.name, packet_in.name, sizeof(char)*10);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_NAMED_VALUE_FLOAT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_NAMED_VALUE_FLOAT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_named_value_float_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_named_value_float_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_named_value_float_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.name , packet1.value );
- mavlink_msg_named_value_float_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_named_value_float_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.name , packet1.value );
- mavlink_msg_named_value_float_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_named_value_float_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_named_value_float_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.name , packet1.value );
- mavlink_msg_named_value_float_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("NAMED_VALUE_FLOAT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_NAMED_VALUE_FLOAT) != NULL);
- #endif
- }
- static void mavlink_test_named_value_int(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_NAMED_VALUE_INT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_named_value_int_t packet_in = {
- 963497464,963497672,"IJKLMNOPQ"
- };
- mavlink_named_value_int_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.value = packet_in.value;
-
- mav_array_memcpy(packet1.name, packet_in.name, sizeof(char)*10);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_NAMED_VALUE_INT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_NAMED_VALUE_INT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_named_value_int_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_named_value_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_named_value_int_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.name , packet1.value );
- mavlink_msg_named_value_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_named_value_int_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.name , packet1.value );
- mavlink_msg_named_value_int_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_named_value_int_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_named_value_int_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.name , packet1.value );
- mavlink_msg_named_value_int_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("NAMED_VALUE_INT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_NAMED_VALUE_INT) != NULL);
- #endif
- }
- static void mavlink_test_statustext(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_STATUSTEXT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_statustext_t packet_in = {
- 5,"BCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWX",19887,228
- };
- mavlink_statustext_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.severity = packet_in.severity;
- packet1.id = packet_in.id;
- packet1.chunk_seq = packet_in.chunk_seq;
-
- mav_array_memcpy(packet1.text, packet_in.text, sizeof(char)*50);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_STATUSTEXT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_STATUSTEXT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_statustext_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_statustext_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_statustext_pack(system_id, component_id, &msg , packet1.severity , packet1.text , packet1.id , packet1.chunk_seq );
- mavlink_msg_statustext_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_statustext_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.severity , packet1.text , packet1.id , packet1.chunk_seq );
- mavlink_msg_statustext_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_statustext_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_statustext_send(MAVLINK_COMM_1 , packet1.severity , packet1.text , packet1.id , packet1.chunk_seq );
- mavlink_msg_statustext_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("STATUSTEXT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_STATUSTEXT) != NULL);
- #endif
- }
- static void mavlink_test_debug(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_DEBUG >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_debug_t packet_in = {
- 963497464,45.0,29
- };
- mavlink_debug_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.value = packet_in.value;
- packet1.ind = packet_in.ind;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_DEBUG_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_DEBUG_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_debug_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_debug_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_debug_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.ind , packet1.value );
- mavlink_msg_debug_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_debug_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.ind , packet1.value );
- mavlink_msg_debug_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_debug_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_debug_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.ind , packet1.value );
- mavlink_msg_debug_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("DEBUG") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_DEBUG) != NULL);
- #endif
- }
- static void mavlink_test_setup_signing(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SETUP_SIGNING >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_setup_signing_t packet_in = {
- 93372036854775807ULL,29,96,{ 163, 164, 165, 166, 167, 168, 169, 170, 171, 172, 173, 174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184, 185, 186, 187, 188, 189, 190, 191, 192, 193, 194 }
- };
- mavlink_setup_signing_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.initial_timestamp = packet_in.initial_timestamp;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
- mav_array_memcpy(packet1.secret_key, packet_in.secret_key, sizeof(uint8_t)*32);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SETUP_SIGNING_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SETUP_SIGNING_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_setup_signing_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_setup_signing_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_setup_signing_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.secret_key , packet1.initial_timestamp );
- mavlink_msg_setup_signing_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_setup_signing_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.secret_key , packet1.initial_timestamp );
- mavlink_msg_setup_signing_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_setup_signing_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_setup_signing_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.secret_key , packet1.initial_timestamp );
- mavlink_msg_setup_signing_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SETUP_SIGNING") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SETUP_SIGNING) != NULL);
- #endif
- }
- static void mavlink_test_button_change(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_BUTTON_CHANGE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_button_change_t packet_in = {
- 963497464,963497672,29
- };
- mavlink_button_change_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.last_change_ms = packet_in.last_change_ms;
- packet1.state = packet_in.state;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_BUTTON_CHANGE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_BUTTON_CHANGE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_button_change_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_button_change_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_button_change_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.last_change_ms , packet1.state );
- mavlink_msg_button_change_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_button_change_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.last_change_ms , packet1.state );
- mavlink_msg_button_change_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_button_change_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_button_change_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.last_change_ms , packet1.state );
- mavlink_msg_button_change_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("BUTTON_CHANGE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_BUTTON_CHANGE) != NULL);
- #endif
- }
- static void mavlink_test_play_tune(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_PLAY_TUNE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_play_tune_t packet_in = {
- 5,72,"CDEFGHIJKLMNOPQRSTUVWXYZABCDE","GHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVW"
- };
- mavlink_play_tune_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
- mav_array_memcpy(packet1.tune, packet_in.tune, sizeof(char)*30);
- mav_array_memcpy(packet1.tune2, packet_in.tune2, sizeof(char)*200);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_PLAY_TUNE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_PLAY_TUNE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_play_tune_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_play_tune_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_play_tune_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.tune , packet1.tune2 );
- mavlink_msg_play_tune_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_play_tune_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.tune , packet1.tune2 );
- mavlink_msg_play_tune_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_play_tune_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_play_tune_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.tune , packet1.tune2 );
- mavlink_msg_play_tune_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("PLAY_TUNE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_PLAY_TUNE) != NULL);
- #endif
- }
- static void mavlink_test_camera_information(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CAMERA_INFORMATION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_camera_information_t packet_in = {
- 963497464,963497672,73.0,101.0,129.0,963498504,18483,18587,18691,{ 223, 224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238, 239, 240, 241, 242, 243, 244, 245, 246, 247, 248, 249, 250, 251, 252, 253, 254 },{ 63, 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78, 79, 80, 81, 82, 83, 84, 85, 86, 87, 88, 89, 90, 91, 92, 93, 94 },159,"RSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZ",134
- };
- mavlink_camera_information_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.firmware_version = packet_in.firmware_version;
- packet1.focal_length = packet_in.focal_length;
- packet1.sensor_size_h = packet_in.sensor_size_h;
- packet1.sensor_size_v = packet_in.sensor_size_v;
- packet1.flags = packet_in.flags;
- packet1.resolution_h = packet_in.resolution_h;
- packet1.resolution_v = packet_in.resolution_v;
- packet1.cam_definition_version = packet_in.cam_definition_version;
- packet1.lens_id = packet_in.lens_id;
- packet1.gimbal_device_id = packet_in.gimbal_device_id;
-
- mav_array_memcpy(packet1.vendor_name, packet_in.vendor_name, sizeof(uint8_t)*32);
- mav_array_memcpy(packet1.model_name, packet_in.model_name, sizeof(uint8_t)*32);
- mav_array_memcpy(packet1.cam_definition_uri, packet_in.cam_definition_uri, sizeof(char)*140);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CAMERA_INFORMATION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CAMERA_INFORMATION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_information_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_camera_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_information_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.vendor_name , packet1.model_name , packet1.firmware_version , packet1.focal_length , packet1.sensor_size_h , packet1.sensor_size_v , packet1.resolution_h , packet1.resolution_v , packet1.lens_id , packet1.flags , packet1.cam_definition_version , packet1.cam_definition_uri , packet1.gimbal_device_id );
- mavlink_msg_camera_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_information_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.vendor_name , packet1.model_name , packet1.firmware_version , packet1.focal_length , packet1.sensor_size_h , packet1.sensor_size_v , packet1.resolution_h , packet1.resolution_v , packet1.lens_id , packet1.flags , packet1.cam_definition_version , packet1.cam_definition_uri , packet1.gimbal_device_id );
- mavlink_msg_camera_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_camera_information_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_information_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.vendor_name , packet1.model_name , packet1.firmware_version , packet1.focal_length , packet1.sensor_size_h , packet1.sensor_size_v , packet1.resolution_h , packet1.resolution_v , packet1.lens_id , packet1.flags , packet1.cam_definition_version , packet1.cam_definition_uri , packet1.gimbal_device_id );
- mavlink_msg_camera_information_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CAMERA_INFORMATION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CAMERA_INFORMATION) != NULL);
- #endif
- }
- static void mavlink_test_camera_settings(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CAMERA_SETTINGS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_camera_settings_t packet_in = {
- 963497464,17,52.0,80.0
- };
- mavlink_camera_settings_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.mode_id = packet_in.mode_id;
- packet1.zoomLevel = packet_in.zoomLevel;
- packet1.focusLevel = packet_in.focusLevel;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CAMERA_SETTINGS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CAMERA_SETTINGS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_settings_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_camera_settings_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_settings_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.mode_id , packet1.zoomLevel , packet1.focusLevel );
- mavlink_msg_camera_settings_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_settings_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.mode_id , packet1.zoomLevel , packet1.focusLevel );
- mavlink_msg_camera_settings_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_camera_settings_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_settings_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.mode_id , packet1.zoomLevel , packet1.focusLevel );
- mavlink_msg_camera_settings_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CAMERA_SETTINGS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CAMERA_SETTINGS) != NULL);
- #endif
- }
- static void mavlink_test_storage_information(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_STORAGE_INFORMATION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_storage_information_t packet_in = {
- 963497464,45.0,73.0,101.0,129.0,157.0,77,144,211,22,"CDEFGHIJKLMNOPQRSTUVWXYZABCDEFG",185
- };
- mavlink_storage_information_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.total_capacity = packet_in.total_capacity;
- packet1.used_capacity = packet_in.used_capacity;
- packet1.available_capacity = packet_in.available_capacity;
- packet1.read_speed = packet_in.read_speed;
- packet1.write_speed = packet_in.write_speed;
- packet1.storage_id = packet_in.storage_id;
- packet1.storage_count = packet_in.storage_count;
- packet1.status = packet_in.status;
- packet1.type = packet_in.type;
- packet1.storage_usage = packet_in.storage_usage;
-
- mav_array_memcpy(packet1.name, packet_in.name, sizeof(char)*32);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_STORAGE_INFORMATION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_STORAGE_INFORMATION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_storage_information_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_storage_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_storage_information_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.storage_id , packet1.storage_count , packet1.status , packet1.total_capacity , packet1.used_capacity , packet1.available_capacity , packet1.read_speed , packet1.write_speed , packet1.type , packet1.name , packet1.storage_usage );
- mavlink_msg_storage_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_storage_information_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.storage_id , packet1.storage_count , packet1.status , packet1.total_capacity , packet1.used_capacity , packet1.available_capacity , packet1.read_speed , packet1.write_speed , packet1.type , packet1.name , packet1.storage_usage );
- mavlink_msg_storage_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_storage_information_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_storage_information_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.storage_id , packet1.storage_count , packet1.status , packet1.total_capacity , packet1.used_capacity , packet1.available_capacity , packet1.read_speed , packet1.write_speed , packet1.type , packet1.name , packet1.storage_usage );
- mavlink_msg_storage_information_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("STORAGE_INFORMATION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_STORAGE_INFORMATION) != NULL);
- #endif
- }
- static void mavlink_test_camera_capture_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CAMERA_CAPTURE_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_camera_capture_status_t packet_in = {
- 963497464,45.0,963497880,101.0,53,120,963498400
- };
- mavlink_camera_capture_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.image_interval = packet_in.image_interval;
- packet1.recording_time_ms = packet_in.recording_time_ms;
- packet1.available_capacity = packet_in.available_capacity;
- packet1.image_status = packet_in.image_status;
- packet1.video_status = packet_in.video_status;
- packet1.image_count = packet_in.image_count;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CAMERA_CAPTURE_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CAMERA_CAPTURE_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_capture_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_camera_capture_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_capture_status_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.image_status , packet1.video_status , packet1.image_interval , packet1.recording_time_ms , packet1.available_capacity , packet1.image_count );
- mavlink_msg_camera_capture_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_capture_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.image_status , packet1.video_status , packet1.image_interval , packet1.recording_time_ms , packet1.available_capacity , packet1.image_count );
- mavlink_msg_camera_capture_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_camera_capture_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_capture_status_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.image_status , packet1.video_status , packet1.image_interval , packet1.recording_time_ms , packet1.available_capacity , packet1.image_count );
- mavlink_msg_camera_capture_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CAMERA_CAPTURE_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CAMERA_CAPTURE_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_camera_image_captured(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CAMERA_IMAGE_CAPTURED >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_camera_image_captured_t packet_in = {
- 93372036854775807ULL,963497880,963498088,963498296,963498504,963498712,{ 213.0, 214.0, 215.0, 216.0 },963499752,149,216,"YZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRST"
- };
- mavlink_camera_image_captured_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_utc = packet_in.time_utc;
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.alt = packet_in.alt;
- packet1.relative_alt = packet_in.relative_alt;
- packet1.image_index = packet_in.image_index;
- packet1.camera_id = packet_in.camera_id;
- packet1.capture_result = packet_in.capture_result;
-
- mav_array_memcpy(packet1.q, packet_in.q, sizeof(float)*4);
- mav_array_memcpy(packet1.file_url, packet_in.file_url, sizeof(char)*205);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CAMERA_IMAGE_CAPTURED_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CAMERA_IMAGE_CAPTURED_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_image_captured_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_camera_image_captured_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_image_captured_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.time_utc , packet1.camera_id , packet1.lat , packet1.lon , packet1.alt , packet1.relative_alt , packet1.q , packet1.image_index , packet1.capture_result , packet1.file_url );
- mavlink_msg_camera_image_captured_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_image_captured_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.time_utc , packet1.camera_id , packet1.lat , packet1.lon , packet1.alt , packet1.relative_alt , packet1.q , packet1.image_index , packet1.capture_result , packet1.file_url );
- mavlink_msg_camera_image_captured_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_camera_image_captured_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_image_captured_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.time_utc , packet1.camera_id , packet1.lat , packet1.lon , packet1.alt , packet1.relative_alt , packet1.q , packet1.image_index , packet1.capture_result , packet1.file_url );
- mavlink_msg_camera_image_captured_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CAMERA_IMAGE_CAPTURED") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CAMERA_IMAGE_CAPTURED) != NULL);
- #endif
- }
- static void mavlink_test_flight_information(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_FLIGHT_INFORMATION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_flight_information_t packet_in = {
- 93372036854775807ULL,93372036854776311ULL,93372036854776815ULL,963498712,963498920
- };
- mavlink_flight_information_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.arming_time_utc = packet_in.arming_time_utc;
- packet1.takeoff_time_utc = packet_in.takeoff_time_utc;
- packet1.flight_uuid = packet_in.flight_uuid;
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.landing_time = packet_in.landing_time;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_FLIGHT_INFORMATION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_FLIGHT_INFORMATION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_flight_information_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_flight_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_flight_information_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.arming_time_utc , packet1.takeoff_time_utc , packet1.flight_uuid , packet1.landing_time );
- mavlink_msg_flight_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_flight_information_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.arming_time_utc , packet1.takeoff_time_utc , packet1.flight_uuid , packet1.landing_time );
- mavlink_msg_flight_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_flight_information_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_flight_information_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.arming_time_utc , packet1.takeoff_time_utc , packet1.flight_uuid , packet1.landing_time );
- mavlink_msg_flight_information_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("FLIGHT_INFORMATION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_FLIGHT_INFORMATION) != NULL);
- #endif
- }
- static void mavlink_test_mount_orientation(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_MOUNT_ORIENTATION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_mount_orientation_t packet_in = {
- 963497464,45.0,73.0,101.0,129.0
- };
- mavlink_mount_orientation_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.roll = packet_in.roll;
- packet1.pitch = packet_in.pitch;
- packet1.yaw = packet_in.yaw;
- packet1.yaw_absolute = packet_in.yaw_absolute;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_MOUNT_ORIENTATION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_MOUNT_ORIENTATION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mount_orientation_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_mount_orientation_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mount_orientation_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.roll , packet1.pitch , packet1.yaw , packet1.yaw_absolute );
- mavlink_msg_mount_orientation_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mount_orientation_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.roll , packet1.pitch , packet1.yaw , packet1.yaw_absolute );
- mavlink_msg_mount_orientation_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_mount_orientation_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_mount_orientation_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.roll , packet1.pitch , packet1.yaw , packet1.yaw_absolute );
- mavlink_msg_mount_orientation_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("MOUNT_ORIENTATION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_MOUNT_ORIENTATION) != NULL);
- #endif
- }
- static void mavlink_test_logging_data(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_LOGGING_DATA >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_logging_data_t packet_in = {
- 17235,139,206,17,84,{ 151, 152, 153, 154, 155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166, 167, 168, 169, 170, 171, 172, 173, 174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184, 185, 186, 187, 188, 189, 190, 191, 192, 193, 194, 195, 196, 197, 198, 199, 200, 201, 202, 203, 204, 205, 206, 207, 208, 209, 210, 211, 212, 213, 214, 215, 216, 217, 218, 219, 220, 221, 222, 223, 224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238, 239, 240, 241, 242, 243, 244, 245, 246, 247, 248, 249, 250, 251, 252, 253, 254, 255, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78, 79, 80, 81, 82, 83, 84, 85, 86, 87, 88, 89, 90, 91, 92, 93, 94, 95, 96, 97, 98, 99, 100, 101, 102, 103, 104, 105, 106, 107, 108, 109, 110, 111, 112, 113, 114, 115, 116, 117, 118, 119, 120, 121, 122, 123, 124, 125, 126, 127, 128, 129, 130, 131, 132, 133, 134, 135, 136, 137, 138, 139, 140, 141, 142, 143 }
- };
- mavlink_logging_data_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.sequence = packet_in.sequence;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.length = packet_in.length;
- packet1.first_message_offset = packet_in.first_message_offset;
-
- mav_array_memcpy(packet1.data, packet_in.data, sizeof(uint8_t)*249);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_LOGGING_DATA_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_LOGGING_DATA_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_logging_data_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_logging_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_logging_data_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.sequence , packet1.length , packet1.first_message_offset , packet1.data );
- mavlink_msg_logging_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_logging_data_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.sequence , packet1.length , packet1.first_message_offset , packet1.data );
- mavlink_msg_logging_data_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_logging_data_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_logging_data_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.sequence , packet1.length , packet1.first_message_offset , packet1.data );
- mavlink_msg_logging_data_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("LOGGING_DATA") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_LOGGING_DATA) != NULL);
- #endif
- }
- static void mavlink_test_logging_data_acked(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_LOGGING_DATA_ACKED >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_logging_data_acked_t packet_in = {
- 17235,139,206,17,84,{ 151, 152, 153, 154, 155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166, 167, 168, 169, 170, 171, 172, 173, 174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184, 185, 186, 187, 188, 189, 190, 191, 192, 193, 194, 195, 196, 197, 198, 199, 200, 201, 202, 203, 204, 205, 206, 207, 208, 209, 210, 211, 212, 213, 214, 215, 216, 217, 218, 219, 220, 221, 222, 223, 224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238, 239, 240, 241, 242, 243, 244, 245, 246, 247, 248, 249, 250, 251, 252, 253, 254, 255, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78, 79, 80, 81, 82, 83, 84, 85, 86, 87, 88, 89, 90, 91, 92, 93, 94, 95, 96, 97, 98, 99, 100, 101, 102, 103, 104, 105, 106, 107, 108, 109, 110, 111, 112, 113, 114, 115, 116, 117, 118, 119, 120, 121, 122, 123, 124, 125, 126, 127, 128, 129, 130, 131, 132, 133, 134, 135, 136, 137, 138, 139, 140, 141, 142, 143 }
- };
- mavlink_logging_data_acked_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.sequence = packet_in.sequence;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.length = packet_in.length;
- packet1.first_message_offset = packet_in.first_message_offset;
-
- mav_array_memcpy(packet1.data, packet_in.data, sizeof(uint8_t)*249);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_LOGGING_DATA_ACKED_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_LOGGING_DATA_ACKED_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_logging_data_acked_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_logging_data_acked_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_logging_data_acked_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.sequence , packet1.length , packet1.first_message_offset , packet1.data );
- mavlink_msg_logging_data_acked_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_logging_data_acked_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.sequence , packet1.length , packet1.first_message_offset , packet1.data );
- mavlink_msg_logging_data_acked_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_logging_data_acked_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_logging_data_acked_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.sequence , packet1.length , packet1.first_message_offset , packet1.data );
- mavlink_msg_logging_data_acked_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("LOGGING_DATA_ACKED") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_LOGGING_DATA_ACKED) != NULL);
- #endif
- }
- static void mavlink_test_logging_ack(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_LOGGING_ACK >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_logging_ack_t packet_in = {
- 17235,139,206
- };
- mavlink_logging_ack_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.sequence = packet_in.sequence;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_LOGGING_ACK_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_LOGGING_ACK_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_logging_ack_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_logging_ack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_logging_ack_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.sequence );
- mavlink_msg_logging_ack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_logging_ack_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.sequence );
- mavlink_msg_logging_ack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_logging_ack_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_logging_ack_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.sequence );
- mavlink_msg_logging_ack_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("LOGGING_ACK") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_LOGGING_ACK) != NULL);
- #endif
- }
- static void mavlink_test_video_stream_information(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_VIDEO_STREAM_INFORMATION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_video_stream_information_t packet_in = {
- 17.0,963497672,17651,17755,17859,17963,18067,187,254,65,"VWXYZABCDEFGHIJKLMNOPQRSTUVWXYZ","BCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCD"
- };
- mavlink_video_stream_information_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.framerate = packet_in.framerate;
- packet1.bitrate = packet_in.bitrate;
- packet1.flags = packet_in.flags;
- packet1.resolution_h = packet_in.resolution_h;
- packet1.resolution_v = packet_in.resolution_v;
- packet1.rotation = packet_in.rotation;
- packet1.hfov = packet_in.hfov;
- packet1.stream_id = packet_in.stream_id;
- packet1.count = packet_in.count;
- packet1.type = packet_in.type;
-
- mav_array_memcpy(packet1.name, packet_in.name, sizeof(char)*32);
- mav_array_memcpy(packet1.uri, packet_in.uri, sizeof(char)*160);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_VIDEO_STREAM_INFORMATION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_VIDEO_STREAM_INFORMATION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_video_stream_information_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_video_stream_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_video_stream_information_pack(system_id, component_id, &msg , packet1.stream_id , packet1.count , packet1.type , packet1.flags , packet1.framerate , packet1.resolution_h , packet1.resolution_v , packet1.bitrate , packet1.rotation , packet1.hfov , packet1.name , packet1.uri );
- mavlink_msg_video_stream_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_video_stream_information_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.stream_id , packet1.count , packet1.type , packet1.flags , packet1.framerate , packet1.resolution_h , packet1.resolution_v , packet1.bitrate , packet1.rotation , packet1.hfov , packet1.name , packet1.uri );
- mavlink_msg_video_stream_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_video_stream_information_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_video_stream_information_send(MAVLINK_COMM_1 , packet1.stream_id , packet1.count , packet1.type , packet1.flags , packet1.framerate , packet1.resolution_h , packet1.resolution_v , packet1.bitrate , packet1.rotation , packet1.hfov , packet1.name , packet1.uri );
- mavlink_msg_video_stream_information_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("VIDEO_STREAM_INFORMATION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_VIDEO_STREAM_INFORMATION) != NULL);
- #endif
- }
- static void mavlink_test_video_stream_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_VIDEO_STREAM_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_video_stream_status_t packet_in = {
- 17.0,963497672,17651,17755,17859,17963,18067,187
- };
- mavlink_video_stream_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.framerate = packet_in.framerate;
- packet1.bitrate = packet_in.bitrate;
- packet1.flags = packet_in.flags;
- packet1.resolution_h = packet_in.resolution_h;
- packet1.resolution_v = packet_in.resolution_v;
- packet1.rotation = packet_in.rotation;
- packet1.hfov = packet_in.hfov;
- packet1.stream_id = packet_in.stream_id;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_VIDEO_STREAM_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_VIDEO_STREAM_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_video_stream_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_video_stream_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_video_stream_status_pack(system_id, component_id, &msg , packet1.stream_id , packet1.flags , packet1.framerate , packet1.resolution_h , packet1.resolution_v , packet1.bitrate , packet1.rotation , packet1.hfov );
- mavlink_msg_video_stream_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_video_stream_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.stream_id , packet1.flags , packet1.framerate , packet1.resolution_h , packet1.resolution_v , packet1.bitrate , packet1.rotation , packet1.hfov );
- mavlink_msg_video_stream_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_video_stream_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_video_stream_status_send(MAVLINK_COMM_1 , packet1.stream_id , packet1.flags , packet1.framerate , packet1.resolution_h , packet1.resolution_v , packet1.bitrate , packet1.rotation , packet1.hfov );
- mavlink_msg_video_stream_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("VIDEO_STREAM_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_VIDEO_STREAM_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_camera_fov_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CAMERA_FOV_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_camera_fov_status_t packet_in = {
- 963497464,963497672,963497880,963498088,963498296,963498504,963498712,{ 213.0, 214.0, 215.0, 216.0 },325.0,353.0
- };
- mavlink_camera_fov_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.lat_camera = packet_in.lat_camera;
- packet1.lon_camera = packet_in.lon_camera;
- packet1.alt_camera = packet_in.alt_camera;
- packet1.lat_image = packet_in.lat_image;
- packet1.lon_image = packet_in.lon_image;
- packet1.alt_image = packet_in.alt_image;
- packet1.hfov = packet_in.hfov;
- packet1.vfov = packet_in.vfov;
-
- mav_array_memcpy(packet1.q, packet_in.q, sizeof(float)*4);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CAMERA_FOV_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CAMERA_FOV_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_fov_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_camera_fov_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_fov_status_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.lat_camera , packet1.lon_camera , packet1.alt_camera , packet1.lat_image , packet1.lon_image , packet1.alt_image , packet1.q , packet1.hfov , packet1.vfov );
- mavlink_msg_camera_fov_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_fov_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.lat_camera , packet1.lon_camera , packet1.alt_camera , packet1.lat_image , packet1.lon_image , packet1.alt_image , packet1.q , packet1.hfov , packet1.vfov );
- mavlink_msg_camera_fov_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_camera_fov_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_fov_status_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.lat_camera , packet1.lon_camera , packet1.alt_camera , packet1.lat_image , packet1.lon_image , packet1.alt_image , packet1.q , packet1.hfov , packet1.vfov );
- mavlink_msg_camera_fov_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CAMERA_FOV_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CAMERA_FOV_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_camera_tracking_image_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CAMERA_TRACKING_IMAGE_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_camera_tracking_image_status_t packet_in = {
- 17.0,45.0,73.0,101.0,129.0,157.0,185.0,89,156,223
- };
- mavlink_camera_tracking_image_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.point_x = packet_in.point_x;
- packet1.point_y = packet_in.point_y;
- packet1.radius = packet_in.radius;
- packet1.rec_top_x = packet_in.rec_top_x;
- packet1.rec_top_y = packet_in.rec_top_y;
- packet1.rec_bottom_x = packet_in.rec_bottom_x;
- packet1.rec_bottom_y = packet_in.rec_bottom_y;
- packet1.tracking_status = packet_in.tracking_status;
- packet1.tracking_mode = packet_in.tracking_mode;
- packet1.target_data = packet_in.target_data;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CAMERA_TRACKING_IMAGE_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CAMERA_TRACKING_IMAGE_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_tracking_image_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_camera_tracking_image_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_tracking_image_status_pack(system_id, component_id, &msg , packet1.tracking_status , packet1.tracking_mode , packet1.target_data , packet1.point_x , packet1.point_y , packet1.radius , packet1.rec_top_x , packet1.rec_top_y , packet1.rec_bottom_x , packet1.rec_bottom_y );
- mavlink_msg_camera_tracking_image_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_tracking_image_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.tracking_status , packet1.tracking_mode , packet1.target_data , packet1.point_x , packet1.point_y , packet1.radius , packet1.rec_top_x , packet1.rec_top_y , packet1.rec_bottom_x , packet1.rec_bottom_y );
- mavlink_msg_camera_tracking_image_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_camera_tracking_image_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_tracking_image_status_send(MAVLINK_COMM_1 , packet1.tracking_status , packet1.tracking_mode , packet1.target_data , packet1.point_x , packet1.point_y , packet1.radius , packet1.rec_top_x , packet1.rec_top_y , packet1.rec_bottom_x , packet1.rec_bottom_y );
- mavlink_msg_camera_tracking_image_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CAMERA_TRACKING_IMAGE_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CAMERA_TRACKING_IMAGE_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_camera_tracking_geo_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CAMERA_TRACKING_GEO_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_camera_tracking_geo_status_t packet_in = {
- 963497464,963497672,73.0,101.0,129.0,157.0,185.0,213.0,241.0,269.0,297.0,325.0,149
- };
- mavlink_camera_tracking_geo_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.alt = packet_in.alt;
- packet1.h_acc = packet_in.h_acc;
- packet1.v_acc = packet_in.v_acc;
- packet1.vel_n = packet_in.vel_n;
- packet1.vel_e = packet_in.vel_e;
- packet1.vel_d = packet_in.vel_d;
- packet1.vel_acc = packet_in.vel_acc;
- packet1.dist = packet_in.dist;
- packet1.hdg = packet_in.hdg;
- packet1.hdg_acc = packet_in.hdg_acc;
- packet1.tracking_status = packet_in.tracking_status;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CAMERA_TRACKING_GEO_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CAMERA_TRACKING_GEO_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_tracking_geo_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_camera_tracking_geo_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_tracking_geo_status_pack(system_id, component_id, &msg , packet1.tracking_status , packet1.lat , packet1.lon , packet1.alt , packet1.h_acc , packet1.v_acc , packet1.vel_n , packet1.vel_e , packet1.vel_d , packet1.vel_acc , packet1.dist , packet1.hdg , packet1.hdg_acc );
- mavlink_msg_camera_tracking_geo_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_tracking_geo_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.tracking_status , packet1.lat , packet1.lon , packet1.alt , packet1.h_acc , packet1.v_acc , packet1.vel_n , packet1.vel_e , packet1.vel_d , packet1.vel_acc , packet1.dist , packet1.hdg , packet1.hdg_acc );
- mavlink_msg_camera_tracking_geo_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_camera_tracking_geo_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_camera_tracking_geo_status_send(MAVLINK_COMM_1 , packet1.tracking_status , packet1.lat , packet1.lon , packet1.alt , packet1.h_acc , packet1.v_acc , packet1.vel_n , packet1.vel_e , packet1.vel_d , packet1.vel_acc , packet1.dist , packet1.hdg , packet1.hdg_acc );
- mavlink_msg_camera_tracking_geo_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CAMERA_TRACKING_GEO_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CAMERA_TRACKING_GEO_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_gimbal_manager_information(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GIMBAL_MANAGER_INFORMATION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gimbal_manager_information_t packet_in = {
- 963497464,963497672,73.0,101.0,129.0,157.0,185.0,213.0,101
- };
- mavlink_gimbal_manager_information_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.cap_flags = packet_in.cap_flags;
- packet1.roll_min = packet_in.roll_min;
- packet1.roll_max = packet_in.roll_max;
- packet1.pitch_min = packet_in.pitch_min;
- packet1.pitch_max = packet_in.pitch_max;
- packet1.yaw_min = packet_in.yaw_min;
- packet1.yaw_max = packet_in.yaw_max;
- packet1.gimbal_device_id = packet_in.gimbal_device_id;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GIMBAL_MANAGER_INFORMATION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GIMBAL_MANAGER_INFORMATION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_information_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gimbal_manager_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_information_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.cap_flags , packet1.gimbal_device_id , packet1.roll_min , packet1.roll_max , packet1.pitch_min , packet1.pitch_max , packet1.yaw_min , packet1.yaw_max );
- mavlink_msg_gimbal_manager_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_information_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.cap_flags , packet1.gimbal_device_id , packet1.roll_min , packet1.roll_max , packet1.pitch_min , packet1.pitch_max , packet1.yaw_min , packet1.yaw_max );
- mavlink_msg_gimbal_manager_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gimbal_manager_information_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_information_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.cap_flags , packet1.gimbal_device_id , packet1.roll_min , packet1.roll_max , packet1.pitch_min , packet1.pitch_max , packet1.yaw_min , packet1.yaw_max );
- mavlink_msg_gimbal_manager_information_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GIMBAL_MANAGER_INFORMATION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GIMBAL_MANAGER_INFORMATION) != NULL);
- #endif
- }
- static void mavlink_test_gimbal_manager_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GIMBAL_MANAGER_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gimbal_manager_status_t packet_in = {
- 963497464,963497672,29,96,163,230,41
- };
- mavlink_gimbal_manager_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.flags = packet_in.flags;
- packet1.gimbal_device_id = packet_in.gimbal_device_id;
- packet1.primary_control_sysid = packet_in.primary_control_sysid;
- packet1.primary_control_compid = packet_in.primary_control_compid;
- packet1.secondary_control_sysid = packet_in.secondary_control_sysid;
- packet1.secondary_control_compid = packet_in.secondary_control_compid;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GIMBAL_MANAGER_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GIMBAL_MANAGER_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gimbal_manager_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_status_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.flags , packet1.gimbal_device_id , packet1.primary_control_sysid , packet1.primary_control_compid , packet1.secondary_control_sysid , packet1.secondary_control_compid );
- mavlink_msg_gimbal_manager_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.flags , packet1.gimbal_device_id , packet1.primary_control_sysid , packet1.primary_control_compid , packet1.secondary_control_sysid , packet1.secondary_control_compid );
- mavlink_msg_gimbal_manager_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gimbal_manager_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_status_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.flags , packet1.gimbal_device_id , packet1.primary_control_sysid , packet1.primary_control_compid , packet1.secondary_control_sysid , packet1.secondary_control_compid );
- mavlink_msg_gimbal_manager_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GIMBAL_MANAGER_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GIMBAL_MANAGER_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_gimbal_manager_set_attitude(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GIMBAL_MANAGER_SET_ATTITUDE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gimbal_manager_set_attitude_t packet_in = {
- 963497464,{ 45.0, 46.0, 47.0, 48.0 },157.0,185.0,213.0,101,168,235
- };
- mavlink_gimbal_manager_set_attitude_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.flags = packet_in.flags;
- packet1.angular_velocity_x = packet_in.angular_velocity_x;
- packet1.angular_velocity_y = packet_in.angular_velocity_y;
- packet1.angular_velocity_z = packet_in.angular_velocity_z;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.gimbal_device_id = packet_in.gimbal_device_id;
-
- mav_array_memcpy(packet1.q, packet_in.q, sizeof(float)*4);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GIMBAL_MANAGER_SET_ATTITUDE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GIMBAL_MANAGER_SET_ATTITUDE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_set_attitude_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gimbal_manager_set_attitude_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_set_attitude_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.flags , packet1.gimbal_device_id , packet1.q , packet1.angular_velocity_x , packet1.angular_velocity_y , packet1.angular_velocity_z );
- mavlink_msg_gimbal_manager_set_attitude_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_set_attitude_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.flags , packet1.gimbal_device_id , packet1.q , packet1.angular_velocity_x , packet1.angular_velocity_y , packet1.angular_velocity_z );
- mavlink_msg_gimbal_manager_set_attitude_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gimbal_manager_set_attitude_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_set_attitude_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.flags , packet1.gimbal_device_id , packet1.q , packet1.angular_velocity_x , packet1.angular_velocity_y , packet1.angular_velocity_z );
- mavlink_msg_gimbal_manager_set_attitude_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GIMBAL_MANAGER_SET_ATTITUDE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GIMBAL_MANAGER_SET_ATTITUDE) != NULL);
- #endif
- }
- static void mavlink_test_gimbal_device_information(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GIMBAL_DEVICE_INFORMATION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gimbal_device_information_t packet_in = {
- 93372036854775807ULL,963497880,963498088,963498296,157.0,185.0,213.0,241.0,269.0,297.0,19523,19627,"WXYZABCDEFGHIJKLMNOPQRSTUVWXYZA","CDEFGHIJKLMNOPQRSTUVWXYZABCDEFG","IJKLMNOPQRSTUVWXYZABCDEFGHIJKLM",181
- };
- mavlink_gimbal_device_information_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.uid = packet_in.uid;
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.firmware_version = packet_in.firmware_version;
- packet1.hardware_version = packet_in.hardware_version;
- packet1.roll_min = packet_in.roll_min;
- packet1.roll_max = packet_in.roll_max;
- packet1.pitch_min = packet_in.pitch_min;
- packet1.pitch_max = packet_in.pitch_max;
- packet1.yaw_min = packet_in.yaw_min;
- packet1.yaw_max = packet_in.yaw_max;
- packet1.cap_flags = packet_in.cap_flags;
- packet1.custom_cap_flags = packet_in.custom_cap_flags;
- packet1.gimbal_device_id = packet_in.gimbal_device_id;
-
- mav_array_memcpy(packet1.vendor_name, packet_in.vendor_name, sizeof(char)*32);
- mav_array_memcpy(packet1.model_name, packet_in.model_name, sizeof(char)*32);
- mav_array_memcpy(packet1.custom_name, packet_in.custom_name, sizeof(char)*32);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GIMBAL_DEVICE_INFORMATION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GIMBAL_DEVICE_INFORMATION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_device_information_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gimbal_device_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_device_information_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.vendor_name , packet1.model_name , packet1.custom_name , packet1.firmware_version , packet1.hardware_version , packet1.uid , packet1.cap_flags , packet1.custom_cap_flags , packet1.roll_min , packet1.roll_max , packet1.pitch_min , packet1.pitch_max , packet1.yaw_min , packet1.yaw_max , packet1.gimbal_device_id );
- mavlink_msg_gimbal_device_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_device_information_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.vendor_name , packet1.model_name , packet1.custom_name , packet1.firmware_version , packet1.hardware_version , packet1.uid , packet1.cap_flags , packet1.custom_cap_flags , packet1.roll_min , packet1.roll_max , packet1.pitch_min , packet1.pitch_max , packet1.yaw_min , packet1.yaw_max , packet1.gimbal_device_id );
- mavlink_msg_gimbal_device_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gimbal_device_information_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_device_information_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.vendor_name , packet1.model_name , packet1.custom_name , packet1.firmware_version , packet1.hardware_version , packet1.uid , packet1.cap_flags , packet1.custom_cap_flags , packet1.roll_min , packet1.roll_max , packet1.pitch_min , packet1.pitch_max , packet1.yaw_min , packet1.yaw_max , packet1.gimbal_device_id );
- mavlink_msg_gimbal_device_information_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GIMBAL_DEVICE_INFORMATION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GIMBAL_DEVICE_INFORMATION) != NULL);
- #endif
- }
- static void mavlink_test_gimbal_device_set_attitude(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gimbal_device_set_attitude_t packet_in = {
- { 17.0, 18.0, 19.0, 20.0 },129.0,157.0,185.0,18691,223,34
- };
- mavlink_gimbal_device_set_attitude_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.angular_velocity_x = packet_in.angular_velocity_x;
- packet1.angular_velocity_y = packet_in.angular_velocity_y;
- packet1.angular_velocity_z = packet_in.angular_velocity_z;
- packet1.flags = packet_in.flags;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
- mav_array_memcpy(packet1.q, packet_in.q, sizeof(float)*4);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_device_set_attitude_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gimbal_device_set_attitude_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_device_set_attitude_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.flags , packet1.q , packet1.angular_velocity_x , packet1.angular_velocity_y , packet1.angular_velocity_z );
- mavlink_msg_gimbal_device_set_attitude_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_device_set_attitude_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.flags , packet1.q , packet1.angular_velocity_x , packet1.angular_velocity_y , packet1.angular_velocity_z );
- mavlink_msg_gimbal_device_set_attitude_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gimbal_device_set_attitude_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_device_set_attitude_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.flags , packet1.q , packet1.angular_velocity_x , packet1.angular_velocity_y , packet1.angular_velocity_z );
- mavlink_msg_gimbal_device_set_attitude_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GIMBAL_DEVICE_SET_ATTITUDE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GIMBAL_DEVICE_SET_ATTITUDE) != NULL);
- #endif
- }
- static void mavlink_test_gimbal_device_attitude_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GIMBAL_DEVICE_ATTITUDE_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gimbal_device_attitude_status_t packet_in = {
- 963497464,{ 45.0, 46.0, 47.0, 48.0 },157.0,185.0,213.0,963499128,19107,247,58,297.0,325.0,149
- };
- mavlink_gimbal_device_attitude_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.angular_velocity_x = packet_in.angular_velocity_x;
- packet1.angular_velocity_y = packet_in.angular_velocity_y;
- packet1.angular_velocity_z = packet_in.angular_velocity_z;
- packet1.failure_flags = packet_in.failure_flags;
- packet1.flags = packet_in.flags;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.delta_yaw = packet_in.delta_yaw;
- packet1.delta_yaw_velocity = packet_in.delta_yaw_velocity;
- packet1.gimbal_device_id = packet_in.gimbal_device_id;
-
- mav_array_memcpy(packet1.q, packet_in.q, sizeof(float)*4);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GIMBAL_DEVICE_ATTITUDE_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GIMBAL_DEVICE_ATTITUDE_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_device_attitude_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gimbal_device_attitude_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_device_attitude_status_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.time_boot_ms , packet1.flags , packet1.q , packet1.angular_velocity_x , packet1.angular_velocity_y , packet1.angular_velocity_z , packet1.failure_flags , packet1.delta_yaw , packet1.delta_yaw_velocity , packet1.gimbal_device_id );
- mavlink_msg_gimbal_device_attitude_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_device_attitude_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.time_boot_ms , packet1.flags , packet1.q , packet1.angular_velocity_x , packet1.angular_velocity_y , packet1.angular_velocity_z , packet1.failure_flags , packet1.delta_yaw , packet1.delta_yaw_velocity , packet1.gimbal_device_id );
- mavlink_msg_gimbal_device_attitude_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gimbal_device_attitude_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_device_attitude_status_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.time_boot_ms , packet1.flags , packet1.q , packet1.angular_velocity_x , packet1.angular_velocity_y , packet1.angular_velocity_z , packet1.failure_flags , packet1.delta_yaw , packet1.delta_yaw_velocity , packet1.gimbal_device_id );
- mavlink_msg_gimbal_device_attitude_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GIMBAL_DEVICE_ATTITUDE_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GIMBAL_DEVICE_ATTITUDE_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_autopilot_state_for_gimbal_device(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_AUTOPILOT_STATE_FOR_GIMBAL_DEVICE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_autopilot_state_for_gimbal_device_t packet_in = {
- 93372036854775807ULL,{ 73.0, 74.0, 75.0, 76.0 },963498712,213.0,241.0,269.0,963499544,325.0,19731,27,94,161,388.0
- };
- mavlink_autopilot_state_for_gimbal_device_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_us = packet_in.time_boot_us;
- packet1.q_estimated_delay_us = packet_in.q_estimated_delay_us;
- packet1.vx = packet_in.vx;
- packet1.vy = packet_in.vy;
- packet1.vz = packet_in.vz;
- packet1.v_estimated_delay_us = packet_in.v_estimated_delay_us;
- packet1.feed_forward_angular_velocity_z = packet_in.feed_forward_angular_velocity_z;
- packet1.estimator_status = packet_in.estimator_status;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.landed_state = packet_in.landed_state;
- packet1.angular_velocity_z = packet_in.angular_velocity_z;
-
- mav_array_memcpy(packet1.q, packet_in.q, sizeof(float)*4);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_AUTOPILOT_STATE_FOR_GIMBAL_DEVICE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_AUTOPILOT_STATE_FOR_GIMBAL_DEVICE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_autopilot_state_for_gimbal_device_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_autopilot_state_for_gimbal_device_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_autopilot_state_for_gimbal_device_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.time_boot_us , packet1.q , packet1.q_estimated_delay_us , packet1.vx , packet1.vy , packet1.vz , packet1.v_estimated_delay_us , packet1.feed_forward_angular_velocity_z , packet1.estimator_status , packet1.landed_state , packet1.angular_velocity_z );
- mavlink_msg_autopilot_state_for_gimbal_device_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_autopilot_state_for_gimbal_device_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.time_boot_us , packet1.q , packet1.q_estimated_delay_us , packet1.vx , packet1.vy , packet1.vz , packet1.v_estimated_delay_us , packet1.feed_forward_angular_velocity_z , packet1.estimator_status , packet1.landed_state , packet1.angular_velocity_z );
- mavlink_msg_autopilot_state_for_gimbal_device_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_autopilot_state_for_gimbal_device_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_autopilot_state_for_gimbal_device_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.time_boot_us , packet1.q , packet1.q_estimated_delay_us , packet1.vx , packet1.vy , packet1.vz , packet1.v_estimated_delay_us , packet1.feed_forward_angular_velocity_z , packet1.estimator_status , packet1.landed_state , packet1.angular_velocity_z );
- mavlink_msg_autopilot_state_for_gimbal_device_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("AUTOPILOT_STATE_FOR_GIMBAL_DEVICE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_AUTOPILOT_STATE_FOR_GIMBAL_DEVICE) != NULL);
- #endif
- }
- static void mavlink_test_gimbal_manager_set_pitchyaw(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GIMBAL_MANAGER_SET_PITCHYAW >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gimbal_manager_set_pitchyaw_t packet_in = {
- 963497464,45.0,73.0,101.0,129.0,65,132,199
- };
- mavlink_gimbal_manager_set_pitchyaw_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.flags = packet_in.flags;
- packet1.pitch = packet_in.pitch;
- packet1.yaw = packet_in.yaw;
- packet1.pitch_rate = packet_in.pitch_rate;
- packet1.yaw_rate = packet_in.yaw_rate;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.gimbal_device_id = packet_in.gimbal_device_id;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GIMBAL_MANAGER_SET_PITCHYAW_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GIMBAL_MANAGER_SET_PITCHYAW_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_set_pitchyaw_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gimbal_manager_set_pitchyaw_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_set_pitchyaw_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.flags , packet1.gimbal_device_id , packet1.pitch , packet1.yaw , packet1.pitch_rate , packet1.yaw_rate );
- mavlink_msg_gimbal_manager_set_pitchyaw_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_set_pitchyaw_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.flags , packet1.gimbal_device_id , packet1.pitch , packet1.yaw , packet1.pitch_rate , packet1.yaw_rate );
- mavlink_msg_gimbal_manager_set_pitchyaw_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gimbal_manager_set_pitchyaw_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_set_pitchyaw_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.flags , packet1.gimbal_device_id , packet1.pitch , packet1.yaw , packet1.pitch_rate , packet1.yaw_rate );
- mavlink_msg_gimbal_manager_set_pitchyaw_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GIMBAL_MANAGER_SET_PITCHYAW") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GIMBAL_MANAGER_SET_PITCHYAW) != NULL);
- #endif
- }
- static void mavlink_test_gimbal_manager_set_manual_control(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GIMBAL_MANAGER_SET_MANUAL_CONTROL >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_gimbal_manager_set_manual_control_t packet_in = {
- 963497464,45.0,73.0,101.0,129.0,65,132,199
- };
- mavlink_gimbal_manager_set_manual_control_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.flags = packet_in.flags;
- packet1.pitch = packet_in.pitch;
- packet1.yaw = packet_in.yaw;
- packet1.pitch_rate = packet_in.pitch_rate;
- packet1.yaw_rate = packet_in.yaw_rate;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.gimbal_device_id = packet_in.gimbal_device_id;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GIMBAL_MANAGER_SET_MANUAL_CONTROL_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GIMBAL_MANAGER_SET_MANUAL_CONTROL_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_set_manual_control_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_gimbal_manager_set_manual_control_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_set_manual_control_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.flags , packet1.gimbal_device_id , packet1.pitch , packet1.yaw , packet1.pitch_rate , packet1.yaw_rate );
- mavlink_msg_gimbal_manager_set_manual_control_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_set_manual_control_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.flags , packet1.gimbal_device_id , packet1.pitch , packet1.yaw , packet1.pitch_rate , packet1.yaw_rate );
- mavlink_msg_gimbal_manager_set_manual_control_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_gimbal_manager_set_manual_control_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_gimbal_manager_set_manual_control_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.flags , packet1.gimbal_device_id , packet1.pitch , packet1.yaw , packet1.pitch_rate , packet1.yaw_rate );
- mavlink_msg_gimbal_manager_set_manual_control_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GIMBAL_MANAGER_SET_MANUAL_CONTROL") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GIMBAL_MANAGER_SET_MANUAL_CONTROL) != NULL);
- #endif
- }
- static void mavlink_test_esc_info(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ESC_INFO >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_esc_info_t packet_in = {
- 93372036854775807ULL,{ 963497880, 963497881, 963497882, 963497883 },18483,{ 18587, 18588, 18589, 18590 },{ 19003, 19004, 19005, 19006 },3,70,137,204
- };
- mavlink_esc_info_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.counter = packet_in.counter;
- packet1.index = packet_in.index;
- packet1.count = packet_in.count;
- packet1.connection_type = packet_in.connection_type;
- packet1.info = packet_in.info;
-
- mav_array_memcpy(packet1.error_count, packet_in.error_count, sizeof(uint32_t)*4);
- mav_array_memcpy(packet1.failure_flags, packet_in.failure_flags, sizeof(uint16_t)*4);
- mav_array_memcpy(packet1.temperature, packet_in.temperature, sizeof(int16_t)*4);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ESC_INFO_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ESC_INFO_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_esc_info_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_esc_info_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_esc_info_pack(system_id, component_id, &msg , packet1.index , packet1.time_usec , packet1.counter , packet1.count , packet1.connection_type , packet1.info , packet1.failure_flags , packet1.error_count , packet1.temperature );
- mavlink_msg_esc_info_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_esc_info_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.index , packet1.time_usec , packet1.counter , packet1.count , packet1.connection_type , packet1.info , packet1.failure_flags , packet1.error_count , packet1.temperature );
- mavlink_msg_esc_info_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_esc_info_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_esc_info_send(MAVLINK_COMM_1 , packet1.index , packet1.time_usec , packet1.counter , packet1.count , packet1.connection_type , packet1.info , packet1.failure_flags , packet1.error_count , packet1.temperature );
- mavlink_msg_esc_info_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ESC_INFO") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ESC_INFO) != NULL);
- #endif
- }
- static void mavlink_test_esc_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ESC_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_esc_status_t packet_in = {
- 93372036854775807ULL,{ 963497880, 963497881, 963497882, 963497883 },{ 185.0, 186.0, 187.0, 188.0 },{ 297.0, 298.0, 299.0, 300.0 },173
- };
- mavlink_esc_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.index = packet_in.index;
-
- mav_array_memcpy(packet1.rpm, packet_in.rpm, sizeof(int32_t)*4);
- mav_array_memcpy(packet1.voltage, packet_in.voltage, sizeof(float)*4);
- mav_array_memcpy(packet1.current, packet_in.current, sizeof(float)*4);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ESC_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ESC_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_esc_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_esc_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_esc_status_pack(system_id, component_id, &msg , packet1.index , packet1.time_usec , packet1.rpm , packet1.voltage , packet1.current );
- mavlink_msg_esc_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_esc_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.index , packet1.time_usec , packet1.rpm , packet1.voltage , packet1.current );
- mavlink_msg_esc_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_esc_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_esc_status_send(MAVLINK_COMM_1 , packet1.index , packet1.time_usec , packet1.rpm , packet1.voltage , packet1.current );
- mavlink_msg_esc_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ESC_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ESC_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_wifi_config_ap(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_WIFI_CONFIG_AP >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_wifi_config_ap_t packet_in = {
- "ABCDEFGHIJKLMNOPQRSTUVWXYZABCDE","GHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQ",37,104
- };
- mavlink_wifi_config_ap_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.mode = packet_in.mode;
- packet1.response = packet_in.response;
-
- mav_array_memcpy(packet1.ssid, packet_in.ssid, sizeof(char)*32);
- mav_array_memcpy(packet1.password, packet_in.password, sizeof(char)*64);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_WIFI_CONFIG_AP_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_WIFI_CONFIG_AP_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_wifi_config_ap_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_wifi_config_ap_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_wifi_config_ap_pack(system_id, component_id, &msg , packet1.ssid , packet1.password , packet1.mode , packet1.response );
- mavlink_msg_wifi_config_ap_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_wifi_config_ap_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.ssid , packet1.password , packet1.mode , packet1.response );
- mavlink_msg_wifi_config_ap_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_wifi_config_ap_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_wifi_config_ap_send(MAVLINK_COMM_1 , packet1.ssid , packet1.password , packet1.mode , packet1.response );
- mavlink_msg_wifi_config_ap_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("WIFI_CONFIG_AP") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_WIFI_CONFIG_AP) != NULL);
- #endif
- }
- static void mavlink_test_ais_vessel(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_AIS_VESSEL >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_ais_vessel_t packet_in = {
- 963497464,963497672,963497880,17859,17963,18067,18171,18275,18379,18483,211,22,89,156,223,"FGHIJK","MNOPQRSTUVWXYZABCDE"
- };
- mavlink_ais_vessel_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.MMSI = packet_in.MMSI;
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.COG = packet_in.COG;
- packet1.heading = packet_in.heading;
- packet1.velocity = packet_in.velocity;
- packet1.dimension_bow = packet_in.dimension_bow;
- packet1.dimension_stern = packet_in.dimension_stern;
- packet1.tslc = packet_in.tslc;
- packet1.flags = packet_in.flags;
- packet1.turn_rate = packet_in.turn_rate;
- packet1.navigational_status = packet_in.navigational_status;
- packet1.type = packet_in.type;
- packet1.dimension_port = packet_in.dimension_port;
- packet1.dimension_starboard = packet_in.dimension_starboard;
-
- mav_array_memcpy(packet1.callsign, packet_in.callsign, sizeof(char)*7);
- mav_array_memcpy(packet1.name, packet_in.name, sizeof(char)*20);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_AIS_VESSEL_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_AIS_VESSEL_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_ais_vessel_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_ais_vessel_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_ais_vessel_pack(system_id, component_id, &msg , packet1.MMSI , packet1.lat , packet1.lon , packet1.COG , packet1.heading , packet1.velocity , packet1.turn_rate , packet1.navigational_status , packet1.type , packet1.dimension_bow , packet1.dimension_stern , packet1.dimension_port , packet1.dimension_starboard , packet1.callsign , packet1.name , packet1.tslc , packet1.flags );
- mavlink_msg_ais_vessel_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_ais_vessel_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.MMSI , packet1.lat , packet1.lon , packet1.COG , packet1.heading , packet1.velocity , packet1.turn_rate , packet1.navigational_status , packet1.type , packet1.dimension_bow , packet1.dimension_stern , packet1.dimension_port , packet1.dimension_starboard , packet1.callsign , packet1.name , packet1.tslc , packet1.flags );
- mavlink_msg_ais_vessel_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_ais_vessel_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_ais_vessel_send(MAVLINK_COMM_1 , packet1.MMSI , packet1.lat , packet1.lon , packet1.COG , packet1.heading , packet1.velocity , packet1.turn_rate , packet1.navigational_status , packet1.type , packet1.dimension_bow , packet1.dimension_stern , packet1.dimension_port , packet1.dimension_starboard , packet1.callsign , packet1.name , packet1.tslc , packet1.flags );
- mavlink_msg_ais_vessel_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("AIS_VESSEL") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_AIS_VESSEL) != NULL);
- #endif
- }
- static void mavlink_test_uavcan_node_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_UAVCAN_NODE_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_uavcan_node_status_t packet_in = {
- 93372036854775807ULL,963497880,17859,175,242,53
- };
- mavlink_uavcan_node_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.uptime_sec = packet_in.uptime_sec;
- packet1.vendor_specific_status_code = packet_in.vendor_specific_status_code;
- packet1.health = packet_in.health;
- packet1.mode = packet_in.mode;
- packet1.sub_mode = packet_in.sub_mode;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_UAVCAN_NODE_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_UAVCAN_NODE_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_uavcan_node_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_uavcan_node_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_uavcan_node_status_pack(system_id, component_id, &msg , packet1.time_usec , packet1.uptime_sec , packet1.health , packet1.mode , packet1.sub_mode , packet1.vendor_specific_status_code );
- mavlink_msg_uavcan_node_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_uavcan_node_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.uptime_sec , packet1.health , packet1.mode , packet1.sub_mode , packet1.vendor_specific_status_code );
- mavlink_msg_uavcan_node_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_uavcan_node_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_uavcan_node_status_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.uptime_sec , packet1.health , packet1.mode , packet1.sub_mode , packet1.vendor_specific_status_code );
- mavlink_msg_uavcan_node_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("UAVCAN_NODE_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_UAVCAN_NODE_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_uavcan_node_info(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_UAVCAN_NODE_INFO >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_uavcan_node_info_t packet_in = {
- 93372036854775807ULL,963497880,963498088,"QRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQ",37,104,{ 171, 172, 173, 174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184, 185, 186 },219,30
- };
- mavlink_uavcan_node_info_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.uptime_sec = packet_in.uptime_sec;
- packet1.sw_vcs_commit = packet_in.sw_vcs_commit;
- packet1.hw_version_major = packet_in.hw_version_major;
- packet1.hw_version_minor = packet_in.hw_version_minor;
- packet1.sw_version_major = packet_in.sw_version_major;
- packet1.sw_version_minor = packet_in.sw_version_minor;
-
- mav_array_memcpy(packet1.name, packet_in.name, sizeof(char)*80);
- mav_array_memcpy(packet1.hw_unique_id, packet_in.hw_unique_id, sizeof(uint8_t)*16);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_UAVCAN_NODE_INFO_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_UAVCAN_NODE_INFO_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_uavcan_node_info_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_uavcan_node_info_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_uavcan_node_info_pack(system_id, component_id, &msg , packet1.time_usec , packet1.uptime_sec , packet1.name , packet1.hw_version_major , packet1.hw_version_minor , packet1.hw_unique_id , packet1.sw_version_major , packet1.sw_version_minor , packet1.sw_vcs_commit );
- mavlink_msg_uavcan_node_info_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_uavcan_node_info_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.uptime_sec , packet1.name , packet1.hw_version_major , packet1.hw_version_minor , packet1.hw_unique_id , packet1.sw_version_major , packet1.sw_version_minor , packet1.sw_vcs_commit );
- mavlink_msg_uavcan_node_info_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_uavcan_node_info_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_uavcan_node_info_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.uptime_sec , packet1.name , packet1.hw_version_major , packet1.hw_version_minor , packet1.hw_unique_id , packet1.sw_version_major , packet1.sw_version_minor , packet1.sw_vcs_commit );
- mavlink_msg_uavcan_node_info_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("UAVCAN_NODE_INFO") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_UAVCAN_NODE_INFO) != NULL);
- #endif
- }
- static void mavlink_test_param_ext_request_read(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_PARAM_EXT_REQUEST_READ >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_param_ext_request_read_t packet_in = {
- 17235,139,206,"EFGHIJKLMNOPQRS"
- };
- mavlink_param_ext_request_read_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.param_index = packet_in.param_index;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
- mav_array_memcpy(packet1.param_id, packet_in.param_id, sizeof(char)*16);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_PARAM_EXT_REQUEST_READ_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_PARAM_EXT_REQUEST_READ_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_request_read_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_param_ext_request_read_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_request_read_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.param_id , packet1.param_index );
- mavlink_msg_param_ext_request_read_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_request_read_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.param_id , packet1.param_index );
- mavlink_msg_param_ext_request_read_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_param_ext_request_read_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_request_read_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.param_id , packet1.param_index );
- mavlink_msg_param_ext_request_read_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("PARAM_EXT_REQUEST_READ") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_PARAM_EXT_REQUEST_READ) != NULL);
- #endif
- }
- static void mavlink_test_param_ext_request_list(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_PARAM_EXT_REQUEST_LIST >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_param_ext_request_list_t packet_in = {
- 5,72
- };
- mavlink_param_ext_request_list_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_PARAM_EXT_REQUEST_LIST_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_PARAM_EXT_REQUEST_LIST_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_request_list_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_param_ext_request_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_request_list_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component );
- mavlink_msg_param_ext_request_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_request_list_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component );
- mavlink_msg_param_ext_request_list_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_param_ext_request_list_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_request_list_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component );
- mavlink_msg_param_ext_request_list_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("PARAM_EXT_REQUEST_LIST") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_PARAM_EXT_REQUEST_LIST) != NULL);
- #endif
- }
- static void mavlink_test_param_ext_value(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_PARAM_EXT_VALUE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_param_ext_value_t packet_in = {
- 17235,17339,"EFGHIJKLMNOPQRS","UVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQ",193
- };
- mavlink_param_ext_value_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.param_count = packet_in.param_count;
- packet1.param_index = packet_in.param_index;
- packet1.param_type = packet_in.param_type;
-
- mav_array_memcpy(packet1.param_id, packet_in.param_id, sizeof(char)*16);
- mav_array_memcpy(packet1.param_value, packet_in.param_value, sizeof(char)*128);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_PARAM_EXT_VALUE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_PARAM_EXT_VALUE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_value_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_param_ext_value_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_value_pack(system_id, component_id, &msg , packet1.param_id , packet1.param_value , packet1.param_type , packet1.param_count , packet1.param_index );
- mavlink_msg_param_ext_value_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_value_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.param_id , packet1.param_value , packet1.param_type , packet1.param_count , packet1.param_index );
- mavlink_msg_param_ext_value_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_param_ext_value_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_value_send(MAVLINK_COMM_1 , packet1.param_id , packet1.param_value , packet1.param_type , packet1.param_count , packet1.param_index );
- mavlink_msg_param_ext_value_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("PARAM_EXT_VALUE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_PARAM_EXT_VALUE) != NULL);
- #endif
- }
- static void mavlink_test_param_ext_set(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_PARAM_EXT_SET >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_param_ext_set_t packet_in = {
- 5,72,"CDEFGHIJKLMNOPQ","STUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNO",59
- };
- mavlink_param_ext_set_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.param_type = packet_in.param_type;
-
- mav_array_memcpy(packet1.param_id, packet_in.param_id, sizeof(char)*16);
- mav_array_memcpy(packet1.param_value, packet_in.param_value, sizeof(char)*128);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_PARAM_EXT_SET_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_PARAM_EXT_SET_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_set_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_param_ext_set_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_set_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.param_id , packet1.param_value , packet1.param_type );
- mavlink_msg_param_ext_set_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_set_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.param_id , packet1.param_value , packet1.param_type );
- mavlink_msg_param_ext_set_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_param_ext_set_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_set_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.param_id , packet1.param_value , packet1.param_type );
- mavlink_msg_param_ext_set_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("PARAM_EXT_SET") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_PARAM_EXT_SET) != NULL);
- #endif
- }
- static void mavlink_test_param_ext_ack(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_PARAM_EXT_ACK >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_param_ext_ack_t packet_in = {
- "ABCDEFGHIJKLMNO","QRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLM",181,248
- };
- mavlink_param_ext_ack_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.param_type = packet_in.param_type;
- packet1.param_result = packet_in.param_result;
-
- mav_array_memcpy(packet1.param_id, packet_in.param_id, sizeof(char)*16);
- mav_array_memcpy(packet1.param_value, packet_in.param_value, sizeof(char)*128);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_PARAM_EXT_ACK_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_PARAM_EXT_ACK_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_ack_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_param_ext_ack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_ack_pack(system_id, component_id, &msg , packet1.param_id , packet1.param_value , packet1.param_type , packet1.param_result );
- mavlink_msg_param_ext_ack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_ack_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.param_id , packet1.param_value , packet1.param_type , packet1.param_result );
- mavlink_msg_param_ext_ack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_param_ext_ack_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_param_ext_ack_send(MAVLINK_COMM_1 , packet1.param_id , packet1.param_value , packet1.param_type , packet1.param_result );
- mavlink_msg_param_ext_ack_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("PARAM_EXT_ACK") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_PARAM_EXT_ACK) != NULL);
- #endif
- }
- static void mavlink_test_obstacle_distance(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_OBSTACLE_DISTANCE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_obstacle_distance_t packet_in = {
- 93372036854775807ULL,{ 17651, 17652, 17653, 17654, 17655, 17656, 17657, 17658, 17659, 17660, 17661, 17662, 17663, 17664, 17665, 17666, 17667, 17668, 17669, 17670, 17671, 17672, 17673, 17674, 17675, 17676, 17677, 17678, 17679, 17680, 17681, 17682, 17683, 17684, 17685, 17686, 17687, 17688, 17689, 17690, 17691, 17692, 17693, 17694, 17695, 17696, 17697, 17698, 17699, 17700, 17701, 17702, 17703, 17704, 17705, 17706, 17707, 17708, 17709, 17710, 17711, 17712, 17713, 17714, 17715, 17716, 17717, 17718, 17719, 17720, 17721, 17722 },25139,25243,217,28,1123.0,1151.0,119
- };
- mavlink_obstacle_distance_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.min_distance = packet_in.min_distance;
- packet1.max_distance = packet_in.max_distance;
- packet1.sensor_type = packet_in.sensor_type;
- packet1.increment = packet_in.increment;
- packet1.increment_f = packet_in.increment_f;
- packet1.angle_offset = packet_in.angle_offset;
- packet1.frame = packet_in.frame;
-
- mav_array_memcpy(packet1.distances, packet_in.distances, sizeof(uint16_t)*72);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_OBSTACLE_DISTANCE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_OBSTACLE_DISTANCE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_obstacle_distance_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_obstacle_distance_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_obstacle_distance_pack(system_id, component_id, &msg , packet1.time_usec , packet1.sensor_type , packet1.distances , packet1.increment , packet1.min_distance , packet1.max_distance , packet1.increment_f , packet1.angle_offset , packet1.frame );
- mavlink_msg_obstacle_distance_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_obstacle_distance_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.sensor_type , packet1.distances , packet1.increment , packet1.min_distance , packet1.max_distance , packet1.increment_f , packet1.angle_offset , packet1.frame );
- mavlink_msg_obstacle_distance_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_obstacle_distance_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_obstacle_distance_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.sensor_type , packet1.distances , packet1.increment , packet1.min_distance , packet1.max_distance , packet1.increment_f , packet1.angle_offset , packet1.frame );
- mavlink_msg_obstacle_distance_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("OBSTACLE_DISTANCE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_OBSTACLE_DISTANCE) != NULL);
- #endif
- }
- static void mavlink_test_odometry(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ODOMETRY >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_odometry_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,{ 157.0, 158.0, 159.0, 160.0 },269.0,297.0,325.0,353.0,381.0,409.0,{ 437.0, 438.0, 439.0, 440.0, 441.0, 442.0, 443.0, 444.0, 445.0, 446.0, 447.0, 448.0, 449.0, 450.0, 451.0, 452.0, 453.0, 454.0, 455.0, 456.0, 457.0 },{ 1025.0, 1026.0, 1027.0, 1028.0, 1029.0, 1030.0, 1031.0, 1032.0, 1033.0, 1034.0, 1035.0, 1036.0, 1037.0, 1038.0, 1039.0, 1040.0, 1041.0, 1042.0, 1043.0, 1044.0, 1045.0 },177,244,55,122,189
- };
- mavlink_odometry_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.vx = packet_in.vx;
- packet1.vy = packet_in.vy;
- packet1.vz = packet_in.vz;
- packet1.rollspeed = packet_in.rollspeed;
- packet1.pitchspeed = packet_in.pitchspeed;
- packet1.yawspeed = packet_in.yawspeed;
- packet1.frame_id = packet_in.frame_id;
- packet1.child_frame_id = packet_in.child_frame_id;
- packet1.reset_counter = packet_in.reset_counter;
- packet1.estimator_type = packet_in.estimator_type;
- packet1.quality = packet_in.quality;
-
- mav_array_memcpy(packet1.q, packet_in.q, sizeof(float)*4);
- mav_array_memcpy(packet1.pose_covariance, packet_in.pose_covariance, sizeof(float)*21);
- mav_array_memcpy(packet1.velocity_covariance, packet_in.velocity_covariance, sizeof(float)*21);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ODOMETRY_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ODOMETRY_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_odometry_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_odometry_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_odometry_pack(system_id, component_id, &msg , packet1.time_usec , packet1.frame_id , packet1.child_frame_id , packet1.x , packet1.y , packet1.z , packet1.q , packet1.vx , packet1.vy , packet1.vz , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed , packet1.pose_covariance , packet1.velocity_covariance , packet1.reset_counter , packet1.estimator_type , packet1.quality );
- mavlink_msg_odometry_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_odometry_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.frame_id , packet1.child_frame_id , packet1.x , packet1.y , packet1.z , packet1.q , packet1.vx , packet1.vy , packet1.vz , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed , packet1.pose_covariance , packet1.velocity_covariance , packet1.reset_counter , packet1.estimator_type , packet1.quality );
- mavlink_msg_odometry_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_odometry_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_odometry_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.frame_id , packet1.child_frame_id , packet1.x , packet1.y , packet1.z , packet1.q , packet1.vx , packet1.vy , packet1.vz , packet1.rollspeed , packet1.pitchspeed , packet1.yawspeed , packet1.pose_covariance , packet1.velocity_covariance , packet1.reset_counter , packet1.estimator_type , packet1.quality );
- mavlink_msg_odometry_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ODOMETRY") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ODOMETRY) != NULL);
- #endif
- }
- static void mavlink_test_trajectory_representation_waypoints(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_TRAJECTORY_REPRESENTATION_WAYPOINTS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_trajectory_representation_waypoints_t packet_in = {
- 93372036854775807ULL,{ 73.0, 74.0, 75.0, 76.0, 77.0 },{ 213.0, 214.0, 215.0, 216.0, 217.0 },{ 353.0, 354.0, 355.0, 356.0, 357.0 },{ 493.0, 494.0, 495.0, 496.0, 497.0 },{ 633.0, 634.0, 635.0, 636.0, 637.0 },{ 773.0, 774.0, 775.0, 776.0, 777.0 },{ 913.0, 914.0, 915.0, 916.0, 917.0 },{ 1053.0, 1054.0, 1055.0, 1056.0, 1057.0 },{ 1193.0, 1194.0, 1195.0, 1196.0, 1197.0 },{ 1333.0, 1334.0, 1335.0, 1336.0, 1337.0 },{ 1473.0, 1474.0, 1475.0, 1476.0, 1477.0 },{ 29091, 29092, 29093, 29094, 29095 },79
- };
- mavlink_trajectory_representation_waypoints_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.valid_points = packet_in.valid_points;
-
- mav_array_memcpy(packet1.pos_x, packet_in.pos_x, sizeof(float)*5);
- mav_array_memcpy(packet1.pos_y, packet_in.pos_y, sizeof(float)*5);
- mav_array_memcpy(packet1.pos_z, packet_in.pos_z, sizeof(float)*5);
- mav_array_memcpy(packet1.vel_x, packet_in.vel_x, sizeof(float)*5);
- mav_array_memcpy(packet1.vel_y, packet_in.vel_y, sizeof(float)*5);
- mav_array_memcpy(packet1.vel_z, packet_in.vel_z, sizeof(float)*5);
- mav_array_memcpy(packet1.acc_x, packet_in.acc_x, sizeof(float)*5);
- mav_array_memcpy(packet1.acc_y, packet_in.acc_y, sizeof(float)*5);
- mav_array_memcpy(packet1.acc_z, packet_in.acc_z, sizeof(float)*5);
- mav_array_memcpy(packet1.pos_yaw, packet_in.pos_yaw, sizeof(float)*5);
- mav_array_memcpy(packet1.vel_yaw, packet_in.vel_yaw, sizeof(float)*5);
- mav_array_memcpy(packet1.command, packet_in.command, sizeof(uint16_t)*5);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_TRAJECTORY_REPRESENTATION_WAYPOINTS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_TRAJECTORY_REPRESENTATION_WAYPOINTS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_trajectory_representation_waypoints_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_trajectory_representation_waypoints_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_trajectory_representation_waypoints_pack(system_id, component_id, &msg , packet1.time_usec , packet1.valid_points , packet1.pos_x , packet1.pos_y , packet1.pos_z , packet1.vel_x , packet1.vel_y , packet1.vel_z , packet1.acc_x , packet1.acc_y , packet1.acc_z , packet1.pos_yaw , packet1.vel_yaw , packet1.command );
- mavlink_msg_trajectory_representation_waypoints_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_trajectory_representation_waypoints_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.valid_points , packet1.pos_x , packet1.pos_y , packet1.pos_z , packet1.vel_x , packet1.vel_y , packet1.vel_z , packet1.acc_x , packet1.acc_y , packet1.acc_z , packet1.pos_yaw , packet1.vel_yaw , packet1.command );
- mavlink_msg_trajectory_representation_waypoints_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_trajectory_representation_waypoints_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_trajectory_representation_waypoints_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.valid_points , packet1.pos_x , packet1.pos_y , packet1.pos_z , packet1.vel_x , packet1.vel_y , packet1.vel_z , packet1.acc_x , packet1.acc_y , packet1.acc_z , packet1.pos_yaw , packet1.vel_yaw , packet1.command );
- mavlink_msg_trajectory_representation_waypoints_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("TRAJECTORY_REPRESENTATION_WAYPOINTS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_TRAJECTORY_REPRESENTATION_WAYPOINTS) != NULL);
- #endif
- }
- static void mavlink_test_trajectory_representation_bezier(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_TRAJECTORY_REPRESENTATION_BEZIER >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_trajectory_representation_bezier_t packet_in = {
- 93372036854775807ULL,{ 73.0, 74.0, 75.0, 76.0, 77.0 },{ 213.0, 214.0, 215.0, 216.0, 217.0 },{ 353.0, 354.0, 355.0, 356.0, 357.0 },{ 493.0, 494.0, 495.0, 496.0, 497.0 },{ 633.0, 634.0, 635.0, 636.0, 637.0 },73
- };
- mavlink_trajectory_representation_bezier_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.valid_points = packet_in.valid_points;
-
- mav_array_memcpy(packet1.pos_x, packet_in.pos_x, sizeof(float)*5);
- mav_array_memcpy(packet1.pos_y, packet_in.pos_y, sizeof(float)*5);
- mav_array_memcpy(packet1.pos_z, packet_in.pos_z, sizeof(float)*5);
- mav_array_memcpy(packet1.delta, packet_in.delta, sizeof(float)*5);
- mav_array_memcpy(packet1.pos_yaw, packet_in.pos_yaw, sizeof(float)*5);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_TRAJECTORY_REPRESENTATION_BEZIER_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_TRAJECTORY_REPRESENTATION_BEZIER_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_trajectory_representation_bezier_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_trajectory_representation_bezier_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_trajectory_representation_bezier_pack(system_id, component_id, &msg , packet1.time_usec , packet1.valid_points , packet1.pos_x , packet1.pos_y , packet1.pos_z , packet1.delta , packet1.pos_yaw );
- mavlink_msg_trajectory_representation_bezier_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_trajectory_representation_bezier_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.valid_points , packet1.pos_x , packet1.pos_y , packet1.pos_z , packet1.delta , packet1.pos_yaw );
- mavlink_msg_trajectory_representation_bezier_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_trajectory_representation_bezier_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_trajectory_representation_bezier_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.valid_points , packet1.pos_x , packet1.pos_y , packet1.pos_z , packet1.delta , packet1.pos_yaw );
- mavlink_msg_trajectory_representation_bezier_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("TRAJECTORY_REPRESENTATION_BEZIER") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_TRAJECTORY_REPRESENTATION_BEZIER) != NULL);
- #endif
- }
- static void mavlink_test_cellular_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CELLULAR_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_cellular_status_t packet_in = {
- 17235,17339,17443,151,218,29,96
- };
- mavlink_cellular_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.mcc = packet_in.mcc;
- packet1.mnc = packet_in.mnc;
- packet1.lac = packet_in.lac;
- packet1.status = packet_in.status;
- packet1.failure_reason = packet_in.failure_reason;
- packet1.type = packet_in.type;
- packet1.quality = packet_in.quality;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CELLULAR_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CELLULAR_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_cellular_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_cellular_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_cellular_status_pack(system_id, component_id, &msg , packet1.status , packet1.failure_reason , packet1.type , packet1.quality , packet1.mcc , packet1.mnc , packet1.lac );
- mavlink_msg_cellular_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_cellular_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.status , packet1.failure_reason , packet1.type , packet1.quality , packet1.mcc , packet1.mnc , packet1.lac );
- mavlink_msg_cellular_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_cellular_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_cellular_status_send(MAVLINK_COMM_1 , packet1.status , packet1.failure_reason , packet1.type , packet1.quality , packet1.mcc , packet1.mnc , packet1.lac );
- mavlink_msg_cellular_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CELLULAR_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CELLULAR_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_isbd_link_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ISBD_LINK_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_isbd_link_status_t packet_in = {
- 93372036854775807ULL,93372036854776311ULL,18067,18171,65,132,199,10
- };
- mavlink_isbd_link_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.timestamp = packet_in.timestamp;
- packet1.last_heartbeat = packet_in.last_heartbeat;
- packet1.failed_sessions = packet_in.failed_sessions;
- packet1.successful_sessions = packet_in.successful_sessions;
- packet1.signal_quality = packet_in.signal_quality;
- packet1.ring_pending = packet_in.ring_pending;
- packet1.tx_session_pending = packet_in.tx_session_pending;
- packet1.rx_session_pending = packet_in.rx_session_pending;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ISBD_LINK_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ISBD_LINK_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_isbd_link_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_isbd_link_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_isbd_link_status_pack(system_id, component_id, &msg , packet1.timestamp , packet1.last_heartbeat , packet1.failed_sessions , packet1.successful_sessions , packet1.signal_quality , packet1.ring_pending , packet1.tx_session_pending , packet1.rx_session_pending );
- mavlink_msg_isbd_link_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_isbd_link_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.timestamp , packet1.last_heartbeat , packet1.failed_sessions , packet1.successful_sessions , packet1.signal_quality , packet1.ring_pending , packet1.tx_session_pending , packet1.rx_session_pending );
- mavlink_msg_isbd_link_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_isbd_link_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_isbd_link_status_send(MAVLINK_COMM_1 , packet1.timestamp , packet1.last_heartbeat , packet1.failed_sessions , packet1.successful_sessions , packet1.signal_quality , packet1.ring_pending , packet1.tx_session_pending , packet1.rx_session_pending );
- mavlink_msg_isbd_link_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ISBD_LINK_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ISBD_LINK_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_cellular_config(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CELLULAR_CONFIG >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_cellular_config_t packet_in = {
- 5,72,"CDEFGHIJKLMNOPQ","STUVWXYZABCDEFG","IJKLMNOPQRSTUVWXYZABCDEFGHIJKLM","OPQRSTUVWXYZABC",123,190
- };
- mavlink_cellular_config_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.enable_lte = packet_in.enable_lte;
- packet1.enable_pin = packet_in.enable_pin;
- packet1.roaming = packet_in.roaming;
- packet1.response = packet_in.response;
-
- mav_array_memcpy(packet1.pin, packet_in.pin, sizeof(char)*16);
- mav_array_memcpy(packet1.new_pin, packet_in.new_pin, sizeof(char)*16);
- mav_array_memcpy(packet1.apn, packet_in.apn, sizeof(char)*32);
- mav_array_memcpy(packet1.puk, packet_in.puk, sizeof(char)*16);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CELLULAR_CONFIG_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CELLULAR_CONFIG_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_cellular_config_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_cellular_config_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_cellular_config_pack(system_id, component_id, &msg , packet1.enable_lte , packet1.enable_pin , packet1.pin , packet1.new_pin , packet1.apn , packet1.puk , packet1.roaming , packet1.response );
- mavlink_msg_cellular_config_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_cellular_config_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.enable_lte , packet1.enable_pin , packet1.pin , packet1.new_pin , packet1.apn , packet1.puk , packet1.roaming , packet1.response );
- mavlink_msg_cellular_config_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_cellular_config_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_cellular_config_send(MAVLINK_COMM_1 , packet1.enable_lte , packet1.enable_pin , packet1.pin , packet1.new_pin , packet1.apn , packet1.puk , packet1.roaming , packet1.response );
- mavlink_msg_cellular_config_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CELLULAR_CONFIG") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CELLULAR_CONFIG) != NULL);
- #endif
- }
- static void mavlink_test_raw_rpm(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_RAW_RPM >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_raw_rpm_t packet_in = {
- 17.0,17
- };
- mavlink_raw_rpm_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.frequency = packet_in.frequency;
- packet1.index = packet_in.index;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_RAW_RPM_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_RAW_RPM_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_raw_rpm_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_raw_rpm_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_raw_rpm_pack(system_id, component_id, &msg , packet1.index , packet1.frequency );
- mavlink_msg_raw_rpm_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_raw_rpm_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.index , packet1.frequency );
- mavlink_msg_raw_rpm_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_raw_rpm_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_raw_rpm_send(MAVLINK_COMM_1 , packet1.index , packet1.frequency );
- mavlink_msg_raw_rpm_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("RAW_RPM") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_RAW_RPM) != NULL);
- #endif
- }
- static void mavlink_test_utm_global_position(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_UTM_GLOBAL_POSITION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_utm_global_position_t packet_in = {
- 93372036854775807ULL,963497880,963498088,963498296,963498504,963498712,963498920,963499128,19107,19211,19315,19419,19523,19627,19731,{ 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44 },209,20
- };
- mavlink_utm_global_position_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time = packet_in.time;
- packet1.lat = packet_in.lat;
- packet1.lon = packet_in.lon;
- packet1.alt = packet_in.alt;
- packet1.relative_alt = packet_in.relative_alt;
- packet1.next_lat = packet_in.next_lat;
- packet1.next_lon = packet_in.next_lon;
- packet1.next_alt = packet_in.next_alt;
- packet1.vx = packet_in.vx;
- packet1.vy = packet_in.vy;
- packet1.vz = packet_in.vz;
- packet1.h_acc = packet_in.h_acc;
- packet1.v_acc = packet_in.v_acc;
- packet1.vel_acc = packet_in.vel_acc;
- packet1.update_rate = packet_in.update_rate;
- packet1.flight_state = packet_in.flight_state;
- packet1.flags = packet_in.flags;
-
- mav_array_memcpy(packet1.uas_id, packet_in.uas_id, sizeof(uint8_t)*18);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_UTM_GLOBAL_POSITION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_UTM_GLOBAL_POSITION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_utm_global_position_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_utm_global_position_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_utm_global_position_pack(system_id, component_id, &msg , packet1.time , packet1.uas_id , packet1.lat , packet1.lon , packet1.alt , packet1.relative_alt , packet1.vx , packet1.vy , packet1.vz , packet1.h_acc , packet1.v_acc , packet1.vel_acc , packet1.next_lat , packet1.next_lon , packet1.next_alt , packet1.update_rate , packet1.flight_state , packet1.flags );
- mavlink_msg_utm_global_position_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_utm_global_position_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time , packet1.uas_id , packet1.lat , packet1.lon , packet1.alt , packet1.relative_alt , packet1.vx , packet1.vy , packet1.vz , packet1.h_acc , packet1.v_acc , packet1.vel_acc , packet1.next_lat , packet1.next_lon , packet1.next_alt , packet1.update_rate , packet1.flight_state , packet1.flags );
- mavlink_msg_utm_global_position_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_utm_global_position_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_utm_global_position_send(MAVLINK_COMM_1 , packet1.time , packet1.uas_id , packet1.lat , packet1.lon , packet1.alt , packet1.relative_alt , packet1.vx , packet1.vy , packet1.vz , packet1.h_acc , packet1.v_acc , packet1.vel_acc , packet1.next_lat , packet1.next_lon , packet1.next_alt , packet1.update_rate , packet1.flight_state , packet1.flags );
- mavlink_msg_utm_global_position_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("UTM_GLOBAL_POSITION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_UTM_GLOBAL_POSITION) != NULL);
- #endif
- }
- static void mavlink_test_debug_float_array(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_DEBUG_FLOAT_ARRAY >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_debug_float_array_t packet_in = {
- 93372036854775807ULL,17651,"KLMNOPQRS",{ 157.0, 158.0, 159.0, 160.0, 161.0, 162.0, 163.0, 164.0, 165.0, 166.0, 167.0, 168.0, 169.0, 170.0, 171.0, 172.0, 173.0, 174.0, 175.0, 176.0, 177.0, 178.0, 179.0, 180.0, 181.0, 182.0, 183.0, 184.0, 185.0, 186.0, 187.0, 188.0, 189.0, 190.0, 191.0, 192.0, 193.0, 194.0, 195.0, 196.0, 197.0, 198.0, 199.0, 200.0, 201.0, 202.0, 203.0, 204.0, 205.0, 206.0, 207.0, 208.0, 209.0, 210.0, 211.0, 212.0, 213.0, 214.0 }
- };
- mavlink_debug_float_array_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.array_id = packet_in.array_id;
-
- mav_array_memcpy(packet1.name, packet_in.name, sizeof(char)*10);
- mav_array_memcpy(packet1.data, packet_in.data, sizeof(float)*58);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_DEBUG_FLOAT_ARRAY_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_DEBUG_FLOAT_ARRAY_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_debug_float_array_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_debug_float_array_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_debug_float_array_pack(system_id, component_id, &msg , packet1.time_usec , packet1.name , packet1.array_id , packet1.data );
- mavlink_msg_debug_float_array_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_debug_float_array_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.name , packet1.array_id , packet1.data );
- mavlink_msg_debug_float_array_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_debug_float_array_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_debug_float_array_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.name , packet1.array_id , packet1.data );
- mavlink_msg_debug_float_array_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("DEBUG_FLOAT_ARRAY") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_DEBUG_FLOAT_ARRAY) != NULL);
- #endif
- }
- static void mavlink_test_orbit_execution_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ORBIT_EXECUTION_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_orbit_execution_status_t packet_in = {
- 93372036854775807ULL,73.0,963498088,963498296,157.0,77
- };
- mavlink_orbit_execution_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.radius = packet_in.radius;
- packet1.x = packet_in.x;
- packet1.y = packet_in.y;
- packet1.z = packet_in.z;
- packet1.frame = packet_in.frame;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ORBIT_EXECUTION_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ORBIT_EXECUTION_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_orbit_execution_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_orbit_execution_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_orbit_execution_status_pack(system_id, component_id, &msg , packet1.time_usec , packet1.radius , packet1.frame , packet1.x , packet1.y , packet1.z );
- mavlink_msg_orbit_execution_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_orbit_execution_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.radius , packet1.frame , packet1.x , packet1.y , packet1.z );
- mavlink_msg_orbit_execution_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_orbit_execution_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_orbit_execution_status_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.radius , packet1.frame , packet1.x , packet1.y , packet1.z );
- mavlink_msg_orbit_execution_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ORBIT_EXECUTION_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ORBIT_EXECUTION_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_battery_info(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_BATTERY_INFO >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_battery_info_t packet_in = {
- 17.0,45.0,73.0,101.0,129.0,157.0,185.0,213.0,241.0,269.0,19315,19419,137,204,15,82,149,"XYZABCDE","GHIJKLMNOPQRSTUVWXYZABCDEFGHIJK","MNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHI"
- };
- mavlink_battery_info_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.discharge_minimum_voltage = packet_in.discharge_minimum_voltage;
- packet1.charging_minimum_voltage = packet_in.charging_minimum_voltage;
- packet1.resting_minimum_voltage = packet_in.resting_minimum_voltage;
- packet1.charging_maximum_voltage = packet_in.charging_maximum_voltage;
- packet1.charging_maximum_current = packet_in.charging_maximum_current;
- packet1.nominal_voltage = packet_in.nominal_voltage;
- packet1.discharge_maximum_current = packet_in.discharge_maximum_current;
- packet1.discharge_maximum_burst_current = packet_in.discharge_maximum_burst_current;
- packet1.design_capacity = packet_in.design_capacity;
- packet1.full_charge_capacity = packet_in.full_charge_capacity;
- packet1.cycle_count = packet_in.cycle_count;
- packet1.weight = packet_in.weight;
- packet1.id = packet_in.id;
- packet1.battery_function = packet_in.battery_function;
- packet1.type = packet_in.type;
- packet1.state_of_health = packet_in.state_of_health;
- packet1.cells_in_series = packet_in.cells_in_series;
-
- mav_array_memcpy(packet1.manufacture_date, packet_in.manufacture_date, sizeof(char)*9);
- mav_array_memcpy(packet1.serial_number, packet_in.serial_number, sizeof(char)*32);
- mav_array_memcpy(packet1.name, packet_in.name, sizeof(char)*50);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_BATTERY_INFO_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_BATTERY_INFO_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_battery_info_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_battery_info_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_battery_info_pack(system_id, component_id, &msg , packet1.id , packet1.battery_function , packet1.type , packet1.state_of_health , packet1.cells_in_series , packet1.cycle_count , packet1.weight , packet1.discharge_minimum_voltage , packet1.charging_minimum_voltage , packet1.resting_minimum_voltage , packet1.charging_maximum_voltage , packet1.charging_maximum_current , packet1.nominal_voltage , packet1.discharge_maximum_current , packet1.discharge_maximum_burst_current , packet1.design_capacity , packet1.full_charge_capacity , packet1.manufacture_date , packet1.serial_number , packet1.name );
- mavlink_msg_battery_info_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_battery_info_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.id , packet1.battery_function , packet1.type , packet1.state_of_health , packet1.cells_in_series , packet1.cycle_count , packet1.weight , packet1.discharge_minimum_voltage , packet1.charging_minimum_voltage , packet1.resting_minimum_voltage , packet1.charging_maximum_voltage , packet1.charging_maximum_current , packet1.nominal_voltage , packet1.discharge_maximum_current , packet1.discharge_maximum_burst_current , packet1.design_capacity , packet1.full_charge_capacity , packet1.manufacture_date , packet1.serial_number , packet1.name );
- mavlink_msg_battery_info_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_battery_info_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_battery_info_send(MAVLINK_COMM_1 , packet1.id , packet1.battery_function , packet1.type , packet1.state_of_health , packet1.cells_in_series , packet1.cycle_count , packet1.weight , packet1.discharge_minimum_voltage , packet1.charging_minimum_voltage , packet1.resting_minimum_voltage , packet1.charging_maximum_voltage , packet1.charging_maximum_current , packet1.nominal_voltage , packet1.discharge_maximum_current , packet1.discharge_maximum_burst_current , packet1.design_capacity , packet1.full_charge_capacity , packet1.manufacture_date , packet1.serial_number , packet1.name );
- mavlink_msg_battery_info_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("BATTERY_INFO") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_BATTERY_INFO) != NULL);
- #endif
- }
- static void mavlink_test_generator_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_GENERATOR_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_generator_status_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,157.0,185.0,963498920,963499128,19107,19211,19315
- };
- mavlink_generator_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.status = packet_in.status;
- packet1.battery_current = packet_in.battery_current;
- packet1.load_current = packet_in.load_current;
- packet1.power_generated = packet_in.power_generated;
- packet1.bus_voltage = packet_in.bus_voltage;
- packet1.bat_current_setpoint = packet_in.bat_current_setpoint;
- packet1.runtime = packet_in.runtime;
- packet1.time_until_maintenance = packet_in.time_until_maintenance;
- packet1.generator_speed = packet_in.generator_speed;
- packet1.rectifier_temperature = packet_in.rectifier_temperature;
- packet1.generator_temperature = packet_in.generator_temperature;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_GENERATOR_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_GENERATOR_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_generator_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_generator_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_generator_status_pack(system_id, component_id, &msg , packet1.status , packet1.generator_speed , packet1.battery_current , packet1.load_current , packet1.power_generated , packet1.bus_voltage , packet1.rectifier_temperature , packet1.bat_current_setpoint , packet1.generator_temperature , packet1.runtime , packet1.time_until_maintenance );
- mavlink_msg_generator_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_generator_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.status , packet1.generator_speed , packet1.battery_current , packet1.load_current , packet1.power_generated , packet1.bus_voltage , packet1.rectifier_temperature , packet1.bat_current_setpoint , packet1.generator_temperature , packet1.runtime , packet1.time_until_maintenance );
- mavlink_msg_generator_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_generator_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_generator_status_send(MAVLINK_COMM_1 , packet1.status , packet1.generator_speed , packet1.battery_current , packet1.load_current , packet1.power_generated , packet1.bus_voltage , packet1.rectifier_temperature , packet1.bat_current_setpoint , packet1.generator_temperature , packet1.runtime , packet1.time_until_maintenance );
- mavlink_msg_generator_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("GENERATOR_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_GENERATOR_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_actuator_output_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ACTUATOR_OUTPUT_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_actuator_output_status_t packet_in = {
- 93372036854775807ULL,963497880,{ 101.0, 102.0, 103.0, 104.0, 105.0, 106.0, 107.0, 108.0, 109.0, 110.0, 111.0, 112.0, 113.0, 114.0, 115.0, 116.0, 117.0, 118.0, 119.0, 120.0, 121.0, 122.0, 123.0, 124.0, 125.0, 126.0, 127.0, 128.0, 129.0, 130.0, 131.0, 132.0 }
- };
- mavlink_actuator_output_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.active = packet_in.active;
-
- mav_array_memcpy(packet1.actuator, packet_in.actuator, sizeof(float)*32);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ACTUATOR_OUTPUT_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ACTUATOR_OUTPUT_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_actuator_output_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_actuator_output_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_actuator_output_status_pack(system_id, component_id, &msg , packet1.time_usec , packet1.active , packet1.actuator );
- mavlink_msg_actuator_output_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_actuator_output_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.active , packet1.actuator );
- mavlink_msg_actuator_output_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_actuator_output_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_actuator_output_status_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.active , packet1.actuator );
- mavlink_msg_actuator_output_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ACTUATOR_OUTPUT_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ACTUATOR_OUTPUT_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_time_estimate_to_target(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_TIME_ESTIMATE_TO_TARGET >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_time_estimate_to_target_t packet_in = {
- 963497464,963497672,963497880,963498088,963498296
- };
- mavlink_time_estimate_to_target_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.safe_return = packet_in.safe_return;
- packet1.land = packet_in.land;
- packet1.mission_next_item = packet_in.mission_next_item;
- packet1.mission_end = packet_in.mission_end;
- packet1.commanded_action = packet_in.commanded_action;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_TIME_ESTIMATE_TO_TARGET_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_TIME_ESTIMATE_TO_TARGET_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_time_estimate_to_target_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_time_estimate_to_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_time_estimate_to_target_pack(system_id, component_id, &msg , packet1.safe_return , packet1.land , packet1.mission_next_item , packet1.mission_end , packet1.commanded_action );
- mavlink_msg_time_estimate_to_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_time_estimate_to_target_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.safe_return , packet1.land , packet1.mission_next_item , packet1.mission_end , packet1.commanded_action );
- mavlink_msg_time_estimate_to_target_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_time_estimate_to_target_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_time_estimate_to_target_send(MAVLINK_COMM_1 , packet1.safe_return , packet1.land , packet1.mission_next_item , packet1.mission_end , packet1.commanded_action );
- mavlink_msg_time_estimate_to_target_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("TIME_ESTIMATE_TO_TARGET") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_TIME_ESTIMATE_TO_TARGET) != NULL);
- #endif
- }
- static void mavlink_test_tunnel(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_TUNNEL >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_tunnel_t packet_in = {
- 17235,139,206,17,{ 84, 85, 86, 87, 88, 89, 90, 91, 92, 93, 94, 95, 96, 97, 98, 99, 100, 101, 102, 103, 104, 105, 106, 107, 108, 109, 110, 111, 112, 113, 114, 115, 116, 117, 118, 119, 120, 121, 122, 123, 124, 125, 126, 127, 128, 129, 130, 131, 132, 133, 134, 135, 136, 137, 138, 139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154, 155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166, 167, 168, 169, 170, 171, 172, 173, 174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184, 185, 186, 187, 188, 189, 190, 191, 192, 193, 194, 195, 196, 197, 198, 199, 200, 201, 202, 203, 204, 205, 206, 207, 208, 209, 210, 211 }
- };
- mavlink_tunnel_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.payload_type = packet_in.payload_type;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.payload_length = packet_in.payload_length;
-
- mav_array_memcpy(packet1.payload, packet_in.payload, sizeof(uint8_t)*128);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_TUNNEL_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_TUNNEL_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_tunnel_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_tunnel_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_tunnel_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.payload_type , packet1.payload_length , packet1.payload );
- mavlink_msg_tunnel_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_tunnel_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.payload_type , packet1.payload_length , packet1.payload );
- mavlink_msg_tunnel_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_tunnel_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_tunnel_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.payload_type , packet1.payload_length , packet1.payload );
- mavlink_msg_tunnel_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("TUNNEL") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_TUNNEL) != NULL);
- #endif
- }
- static void mavlink_test_can_frame(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CAN_FRAME >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_can_frame_t packet_in = {
- 963497464,17,84,151,218,{ 29, 30, 31, 32, 33, 34, 35, 36 }
- };
- mavlink_can_frame_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.id = packet_in.id;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.bus = packet_in.bus;
- packet1.len = packet_in.len;
-
- mav_array_memcpy(packet1.data, packet_in.data, sizeof(uint8_t)*8);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CAN_FRAME_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CAN_FRAME_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_can_frame_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_can_frame_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_can_frame_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.bus , packet1.len , packet1.id , packet1.data );
- mavlink_msg_can_frame_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_can_frame_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.bus , packet1.len , packet1.id , packet1.data );
- mavlink_msg_can_frame_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_can_frame_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_can_frame_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.bus , packet1.len , packet1.id , packet1.data );
- mavlink_msg_can_frame_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CAN_FRAME") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CAN_FRAME) != NULL);
- #endif
- }
- static void mavlink_test_onboard_computer_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_ONBOARD_COMPUTER_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_onboard_computer_status_t packet_in = {
- 93372036854775807ULL,963497880,963498088,963498296,{ 963498504, 963498505, 963498506, 963498507 },{ 963499336, 963499337, 963499338, 963499339 },{ 963500168, 963500169, 963500170, 963500171 },{ 963501000, 963501001, 963501002, 963501003, 963501004, 963501005 },{ 963502248, 963502249, 963502250, 963502251, 963502252, 963502253 },{ 963503496, 963503497, 963503498, 963503499, 963503500, 963503501 },{ 963504744, 963504745, 963504746, 963504747, 963504748, 963504749 },{ 963505992, 963505993, 963505994, 963505995, 963505996, 963505997 },{ 27011, 27012, 27013, 27014 },81,{ 148, 149, 150, 151, 152, 153, 154, 155 },{ 172, 173, 174, 175, 176, 177, 178, 179, 180, 181 },{ 74, 75, 76, 77 },{ 86, 87, 88, 89, 90, 91, 92, 93, 94, 95 },244,{ 55, 56, 57, 58, 59, 60, 61, 62 }
- };
- mavlink_onboard_computer_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.uptime = packet_in.uptime;
- packet1.ram_usage = packet_in.ram_usage;
- packet1.ram_total = packet_in.ram_total;
- packet1.type = packet_in.type;
- packet1.temperature_board = packet_in.temperature_board;
-
- mav_array_memcpy(packet1.storage_type, packet_in.storage_type, sizeof(uint32_t)*4);
- mav_array_memcpy(packet1.storage_usage, packet_in.storage_usage, sizeof(uint32_t)*4);
- mav_array_memcpy(packet1.storage_total, packet_in.storage_total, sizeof(uint32_t)*4);
- mav_array_memcpy(packet1.link_type, packet_in.link_type, sizeof(uint32_t)*6);
- mav_array_memcpy(packet1.link_tx_rate, packet_in.link_tx_rate, sizeof(uint32_t)*6);
- mav_array_memcpy(packet1.link_rx_rate, packet_in.link_rx_rate, sizeof(uint32_t)*6);
- mav_array_memcpy(packet1.link_tx_max, packet_in.link_tx_max, sizeof(uint32_t)*6);
- mav_array_memcpy(packet1.link_rx_max, packet_in.link_rx_max, sizeof(uint32_t)*6);
- mav_array_memcpy(packet1.fan_speed, packet_in.fan_speed, sizeof(int16_t)*4);
- mav_array_memcpy(packet1.cpu_cores, packet_in.cpu_cores, sizeof(uint8_t)*8);
- mav_array_memcpy(packet1.cpu_combined, packet_in.cpu_combined, sizeof(uint8_t)*10);
- mav_array_memcpy(packet1.gpu_cores, packet_in.gpu_cores, sizeof(uint8_t)*4);
- mav_array_memcpy(packet1.gpu_combined, packet_in.gpu_combined, sizeof(uint8_t)*10);
- mav_array_memcpy(packet1.temperature_core, packet_in.temperature_core, sizeof(int8_t)*8);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_ONBOARD_COMPUTER_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_ONBOARD_COMPUTER_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_onboard_computer_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_onboard_computer_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_onboard_computer_status_pack(system_id, component_id, &msg , packet1.time_usec , packet1.uptime , packet1.type , packet1.cpu_cores , packet1.cpu_combined , packet1.gpu_cores , packet1.gpu_combined , packet1.temperature_board , packet1.temperature_core , packet1.fan_speed , packet1.ram_usage , packet1.ram_total , packet1.storage_type , packet1.storage_usage , packet1.storage_total , packet1.link_type , packet1.link_tx_rate , packet1.link_rx_rate , packet1.link_tx_max , packet1.link_rx_max );
- mavlink_msg_onboard_computer_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_onboard_computer_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.uptime , packet1.type , packet1.cpu_cores , packet1.cpu_combined , packet1.gpu_cores , packet1.gpu_combined , packet1.temperature_board , packet1.temperature_core , packet1.fan_speed , packet1.ram_usage , packet1.ram_total , packet1.storage_type , packet1.storage_usage , packet1.storage_total , packet1.link_type , packet1.link_tx_rate , packet1.link_rx_rate , packet1.link_tx_max , packet1.link_rx_max );
- mavlink_msg_onboard_computer_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_onboard_computer_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_onboard_computer_status_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.uptime , packet1.type , packet1.cpu_cores , packet1.cpu_combined , packet1.gpu_cores , packet1.gpu_combined , packet1.temperature_board , packet1.temperature_core , packet1.fan_speed , packet1.ram_usage , packet1.ram_total , packet1.storage_type , packet1.storage_usage , packet1.storage_total , packet1.link_type , packet1.link_tx_rate , packet1.link_rx_rate , packet1.link_tx_max , packet1.link_rx_max );
- mavlink_msg_onboard_computer_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("ONBOARD_COMPUTER_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_ONBOARD_COMPUTER_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_component_information(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_COMPONENT_INFORMATION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_component_information_t packet_in = {
- 963497464,963497672,963497880,"MNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFG","IJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABC"
- };
- mavlink_component_information_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.general_metadata_file_crc = packet_in.general_metadata_file_crc;
- packet1.peripherals_metadata_file_crc = packet_in.peripherals_metadata_file_crc;
-
- mav_array_memcpy(packet1.general_metadata_uri, packet_in.general_metadata_uri, sizeof(char)*100);
- mav_array_memcpy(packet1.peripherals_metadata_uri, packet_in.peripherals_metadata_uri, sizeof(char)*100);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_COMPONENT_INFORMATION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_COMPONENT_INFORMATION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_component_information_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_component_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_component_information_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.general_metadata_file_crc , packet1.general_metadata_uri , packet1.peripherals_metadata_file_crc , packet1.peripherals_metadata_uri );
- mavlink_msg_component_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_component_information_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.general_metadata_file_crc , packet1.general_metadata_uri , packet1.peripherals_metadata_file_crc , packet1.peripherals_metadata_uri );
- mavlink_msg_component_information_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_component_information_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_component_information_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.general_metadata_file_crc , packet1.general_metadata_uri , packet1.peripherals_metadata_file_crc , packet1.peripherals_metadata_uri );
- mavlink_msg_component_information_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("COMPONENT_INFORMATION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_COMPONENT_INFORMATION) != NULL);
- #endif
- }
- static void mavlink_test_component_metadata(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_COMPONENT_METADATA >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_component_metadata_t packet_in = {
- 963497464,963497672,"IJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABC"
- };
- mavlink_component_metadata_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_boot_ms = packet_in.time_boot_ms;
- packet1.file_crc = packet_in.file_crc;
-
- mav_array_memcpy(packet1.uri, packet_in.uri, sizeof(char)*100);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_COMPONENT_METADATA_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_COMPONENT_METADATA_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_component_metadata_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_component_metadata_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_component_metadata_pack(system_id, component_id, &msg , packet1.time_boot_ms , packet1.file_crc , packet1.uri );
- mavlink_msg_component_metadata_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_component_metadata_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_boot_ms , packet1.file_crc , packet1.uri );
- mavlink_msg_component_metadata_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_component_metadata_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_component_metadata_send(MAVLINK_COMM_1 , packet1.time_boot_ms , packet1.file_crc , packet1.uri );
- mavlink_msg_component_metadata_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("COMPONENT_METADATA") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_COMPONENT_METADATA) != NULL);
- #endif
- }
- static void mavlink_test_play_tune_v2(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_PLAY_TUNE_V2 >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_play_tune_v2_t packet_in = {
- 963497464,17,84,"GHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRS"
- };
- mavlink_play_tune_v2_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.format = packet_in.format;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
- mav_array_memcpy(packet1.tune, packet_in.tune, sizeof(char)*248);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_PLAY_TUNE_V2_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_PLAY_TUNE_V2_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_play_tune_v2_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_play_tune_v2_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_play_tune_v2_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.format , packet1.tune );
- mavlink_msg_play_tune_v2_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_play_tune_v2_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.format , packet1.tune );
- mavlink_msg_play_tune_v2_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_play_tune_v2_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_play_tune_v2_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.format , packet1.tune );
- mavlink_msg_play_tune_v2_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("PLAY_TUNE_V2") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_PLAY_TUNE_V2) != NULL);
- #endif
- }
- static void mavlink_test_supported_tunes(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_SUPPORTED_TUNES >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_supported_tunes_t packet_in = {
- 963497464,17,84
- };
- mavlink_supported_tunes_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.format = packet_in.format;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_SUPPORTED_TUNES_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_SUPPORTED_TUNES_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_supported_tunes_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_supported_tunes_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_supported_tunes_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.format );
- mavlink_msg_supported_tunes_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_supported_tunes_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.format );
- mavlink_msg_supported_tunes_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_supported_tunes_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_supported_tunes_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.format );
- mavlink_msg_supported_tunes_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("SUPPORTED_TUNES") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_SUPPORTED_TUNES) != NULL);
- #endif
- }
- static void mavlink_test_event(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_EVENT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_event_t packet_in = {
- 963497464,963497672,17651,163,230,41,{ 108, 109, 110, 111, 112, 113, 114, 115, 116, 117, 118, 119, 120, 121, 122, 123, 124, 125, 126, 127, 128, 129, 130, 131, 132, 133, 134, 135, 136, 137, 138, 139, 140, 141, 142, 143, 144, 145, 146, 147 }
- };
- mavlink_event_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.id = packet_in.id;
- packet1.event_time_boot_ms = packet_in.event_time_boot_ms;
- packet1.sequence = packet_in.sequence;
- packet1.destination_component = packet_in.destination_component;
- packet1.destination_system = packet_in.destination_system;
- packet1.log_levels = packet_in.log_levels;
-
- mav_array_memcpy(packet1.arguments, packet_in.arguments, sizeof(uint8_t)*40);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_EVENT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_EVENT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_event_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_event_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_event_pack(system_id, component_id, &msg , packet1.destination_component , packet1.destination_system , packet1.id , packet1.event_time_boot_ms , packet1.sequence , packet1.log_levels , packet1.arguments );
- mavlink_msg_event_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_event_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.destination_component , packet1.destination_system , packet1.id , packet1.event_time_boot_ms , packet1.sequence , packet1.log_levels , packet1.arguments );
- mavlink_msg_event_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_event_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_event_send(MAVLINK_COMM_1 , packet1.destination_component , packet1.destination_system , packet1.id , packet1.event_time_boot_ms , packet1.sequence , packet1.log_levels , packet1.arguments );
- mavlink_msg_event_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("EVENT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_EVENT) != NULL);
- #endif
- }
- static void mavlink_test_current_event_sequence(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CURRENT_EVENT_SEQUENCE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_current_event_sequence_t packet_in = {
- 17235,139
- };
- mavlink_current_event_sequence_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.sequence = packet_in.sequence;
- packet1.flags = packet_in.flags;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CURRENT_EVENT_SEQUENCE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CURRENT_EVENT_SEQUENCE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_current_event_sequence_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_current_event_sequence_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_current_event_sequence_pack(system_id, component_id, &msg , packet1.sequence , packet1.flags );
- mavlink_msg_current_event_sequence_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_current_event_sequence_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.sequence , packet1.flags );
- mavlink_msg_current_event_sequence_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_current_event_sequence_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_current_event_sequence_send(MAVLINK_COMM_1 , packet1.sequence , packet1.flags );
- mavlink_msg_current_event_sequence_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CURRENT_EVENT_SEQUENCE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CURRENT_EVENT_SEQUENCE) != NULL);
- #endif
- }
- static void mavlink_test_request_event(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_REQUEST_EVENT >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_request_event_t packet_in = {
- 17235,17339,17,84
- };
- mavlink_request_event_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.first_sequence = packet_in.first_sequence;
- packet1.last_sequence = packet_in.last_sequence;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_REQUEST_EVENT_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_REQUEST_EVENT_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_request_event_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_request_event_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_request_event_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.first_sequence , packet1.last_sequence );
- mavlink_msg_request_event_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_request_event_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.first_sequence , packet1.last_sequence );
- mavlink_msg_request_event_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_request_event_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_request_event_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.first_sequence , packet1.last_sequence );
- mavlink_msg_request_event_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("REQUEST_EVENT") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_REQUEST_EVENT) != NULL);
- #endif
- }
- static void mavlink_test_response_event_error(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_RESPONSE_EVENT_ERROR >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_response_event_error_t packet_in = {
- 17235,17339,17,84,151
- };
- mavlink_response_event_error_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.sequence = packet_in.sequence;
- packet1.sequence_oldest_available = packet_in.sequence_oldest_available;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.reason = packet_in.reason;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_RESPONSE_EVENT_ERROR_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_RESPONSE_EVENT_ERROR_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_response_event_error_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_response_event_error_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_response_event_error_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.sequence , packet1.sequence_oldest_available , packet1.reason );
- mavlink_msg_response_event_error_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_response_event_error_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.sequence , packet1.sequence_oldest_available , packet1.reason );
- mavlink_msg_response_event_error_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_response_event_error_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_response_event_error_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.sequence , packet1.sequence_oldest_available , packet1.reason );
- mavlink_msg_response_event_error_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("RESPONSE_EVENT_ERROR") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_RESPONSE_EVENT_ERROR) != NULL);
- #endif
- }
- static void mavlink_test_canfd_frame(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CANFD_FRAME >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_canfd_frame_t packet_in = {
- 963497464,17,84,151,218,{ 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78, 79, 80, 81, 82, 83, 84, 85, 86, 87, 88, 89, 90, 91, 92 }
- };
- mavlink_canfd_frame_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.id = packet_in.id;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.bus = packet_in.bus;
- packet1.len = packet_in.len;
-
- mav_array_memcpy(packet1.data, packet_in.data, sizeof(uint8_t)*64);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CANFD_FRAME_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CANFD_FRAME_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_canfd_frame_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_canfd_frame_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_canfd_frame_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.bus , packet1.len , packet1.id , packet1.data );
- mavlink_msg_canfd_frame_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_canfd_frame_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.bus , packet1.len , packet1.id , packet1.data );
- mavlink_msg_canfd_frame_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_canfd_frame_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_canfd_frame_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.bus , packet1.len , packet1.id , packet1.data );
- mavlink_msg_canfd_frame_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CANFD_FRAME") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CANFD_FRAME) != NULL);
- #endif
- }
- static void mavlink_test_can_filter_modify(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_CAN_FILTER_MODIFY >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_can_filter_modify_t packet_in = {
- { 17235, 17236, 17237, 17238, 17239, 17240, 17241, 17242, 17243, 17244, 17245, 17246, 17247, 17248, 17249, 17250 },101,168,235,46,113
- };
- mavlink_can_filter_modify_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.bus = packet_in.bus;
- packet1.operation = packet_in.operation;
- packet1.num_ids = packet_in.num_ids;
-
- mav_array_memcpy(packet1.ids, packet_in.ids, sizeof(uint16_t)*16);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_CAN_FILTER_MODIFY_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_CAN_FILTER_MODIFY_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_can_filter_modify_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_can_filter_modify_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_can_filter_modify_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.bus , packet1.operation , packet1.num_ids , packet1.ids );
- mavlink_msg_can_filter_modify_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_can_filter_modify_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.bus , packet1.operation , packet1.num_ids , packet1.ids );
- mavlink_msg_can_filter_modify_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_can_filter_modify_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_can_filter_modify_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.bus , packet1.operation , packet1.num_ids , packet1.ids );
- mavlink_msg_can_filter_modify_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("CAN_FILTER_MODIFY") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_CAN_FILTER_MODIFY) != NULL);
- #endif
- }
- static void mavlink_test_wheel_distance(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_WHEEL_DISTANCE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_wheel_distance_t packet_in = {
- 93372036854775807ULL,{ 179.0, 180.0, 181.0, 182.0, 183.0, 184.0, 185.0, 186.0, 187.0, 188.0, 189.0, 190.0, 191.0, 192.0, 193.0, 194.0 },157
- };
- mavlink_wheel_distance_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.count = packet_in.count;
-
- mav_array_memcpy(packet1.distance, packet_in.distance, sizeof(double)*16);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_WHEEL_DISTANCE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_WHEEL_DISTANCE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_wheel_distance_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_wheel_distance_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_wheel_distance_pack(system_id, component_id, &msg , packet1.time_usec , packet1.count , packet1.distance );
- mavlink_msg_wheel_distance_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_wheel_distance_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.count , packet1.distance );
- mavlink_msg_wheel_distance_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_wheel_distance_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_wheel_distance_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.count , packet1.distance );
- mavlink_msg_wheel_distance_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("WHEEL_DISTANCE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_WHEEL_DISTANCE) != NULL);
- #endif
- }
- static void mavlink_test_winch_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_WINCH_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_winch_status_t packet_in = {
- 93372036854775807ULL,73.0,101.0,129.0,157.0,185.0,963498920,18899
- };
- mavlink_winch_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.time_usec = packet_in.time_usec;
- packet1.line_length = packet_in.line_length;
- packet1.speed = packet_in.speed;
- packet1.tension = packet_in.tension;
- packet1.voltage = packet_in.voltage;
- packet1.current = packet_in.current;
- packet1.status = packet_in.status;
- packet1.temperature = packet_in.temperature;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_WINCH_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_WINCH_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_winch_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_winch_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_winch_status_pack(system_id, component_id, &msg , packet1.time_usec , packet1.line_length , packet1.speed , packet1.tension , packet1.voltage , packet1.current , packet1.temperature , packet1.status );
- mavlink_msg_winch_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_winch_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.time_usec , packet1.line_length , packet1.speed , packet1.tension , packet1.voltage , packet1.current , packet1.temperature , packet1.status );
- mavlink_msg_winch_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_winch_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_winch_status_send(MAVLINK_COMM_1 , packet1.time_usec , packet1.line_length , packet1.speed , packet1.tension , packet1.voltage , packet1.current , packet1.temperature , packet1.status );
- mavlink_msg_winch_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("WINCH_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_WINCH_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_open_drone_id_basic_id(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_OPEN_DRONE_ID_BASIC_ID >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_open_drone_id_basic_id_t packet_in = {
- 5,72,{ 139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154, 155, 156, 157, 158 },199,10,{ 77, 78, 79, 80, 81, 82, 83, 84, 85, 86, 87, 88, 89, 90, 91, 92, 93, 94, 95, 96 }
- };
- mavlink_open_drone_id_basic_id_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.id_type = packet_in.id_type;
- packet1.ua_type = packet_in.ua_type;
-
- mav_array_memcpy(packet1.id_or_mac, packet_in.id_or_mac, sizeof(uint8_t)*20);
- mav_array_memcpy(packet1.uas_id, packet_in.uas_id, sizeof(uint8_t)*20);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_OPEN_DRONE_ID_BASIC_ID_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_OPEN_DRONE_ID_BASIC_ID_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_basic_id_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_open_drone_id_basic_id_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_basic_id_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.id_type , packet1.ua_type , packet1.uas_id );
- mavlink_msg_open_drone_id_basic_id_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_basic_id_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.id_type , packet1.ua_type , packet1.uas_id );
- mavlink_msg_open_drone_id_basic_id_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_open_drone_id_basic_id_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_basic_id_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.id_type , packet1.ua_type , packet1.uas_id );
- mavlink_msg_open_drone_id_basic_id_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("OPEN_DRONE_ID_BASIC_ID") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_OPEN_DRONE_ID_BASIC_ID) != NULL);
- #endif
- }
- static void mavlink_test_open_drone_id_location(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_OPEN_DRONE_ID_LOCATION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_open_drone_id_location_t packet_in = {
- 963497464,963497672,73.0,101.0,129.0,157.0,18483,18587,18691,223,34,{ 101, 102, 103, 104, 105, 106, 107, 108, 109, 110, 111, 112, 113, 114, 115, 116, 117, 118, 119, 120 },161,228,39,106,173,240,51
- };
- mavlink_open_drone_id_location_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.latitude = packet_in.latitude;
- packet1.longitude = packet_in.longitude;
- packet1.altitude_barometric = packet_in.altitude_barometric;
- packet1.altitude_geodetic = packet_in.altitude_geodetic;
- packet1.height = packet_in.height;
- packet1.timestamp = packet_in.timestamp;
- packet1.direction = packet_in.direction;
- packet1.speed_horizontal = packet_in.speed_horizontal;
- packet1.speed_vertical = packet_in.speed_vertical;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.status = packet_in.status;
- packet1.height_reference = packet_in.height_reference;
- packet1.horizontal_accuracy = packet_in.horizontal_accuracy;
- packet1.vertical_accuracy = packet_in.vertical_accuracy;
- packet1.barometer_accuracy = packet_in.barometer_accuracy;
- packet1.speed_accuracy = packet_in.speed_accuracy;
- packet1.timestamp_accuracy = packet_in.timestamp_accuracy;
-
- mav_array_memcpy(packet1.id_or_mac, packet_in.id_or_mac, sizeof(uint8_t)*20);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_OPEN_DRONE_ID_LOCATION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_OPEN_DRONE_ID_LOCATION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_location_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_open_drone_id_location_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_location_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.status , packet1.direction , packet1.speed_horizontal , packet1.speed_vertical , packet1.latitude , packet1.longitude , packet1.altitude_barometric , packet1.altitude_geodetic , packet1.height_reference , packet1.height , packet1.horizontal_accuracy , packet1.vertical_accuracy , packet1.barometer_accuracy , packet1.speed_accuracy , packet1.timestamp , packet1.timestamp_accuracy );
- mavlink_msg_open_drone_id_location_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_location_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.status , packet1.direction , packet1.speed_horizontal , packet1.speed_vertical , packet1.latitude , packet1.longitude , packet1.altitude_barometric , packet1.altitude_geodetic , packet1.height_reference , packet1.height , packet1.horizontal_accuracy , packet1.vertical_accuracy , packet1.barometer_accuracy , packet1.speed_accuracy , packet1.timestamp , packet1.timestamp_accuracy );
- mavlink_msg_open_drone_id_location_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_open_drone_id_location_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_location_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.status , packet1.direction , packet1.speed_horizontal , packet1.speed_vertical , packet1.latitude , packet1.longitude , packet1.altitude_barometric , packet1.altitude_geodetic , packet1.height_reference , packet1.height , packet1.horizontal_accuracy , packet1.vertical_accuracy , packet1.barometer_accuracy , packet1.speed_accuracy , packet1.timestamp , packet1.timestamp_accuracy );
- mavlink_msg_open_drone_id_location_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("OPEN_DRONE_ID_LOCATION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_OPEN_DRONE_ID_LOCATION) != NULL);
- #endif
- }
- static void mavlink_test_open_drone_id_authentication(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_OPEN_DRONE_ID_AUTHENTICATION >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_open_drone_id_authentication_t packet_in = {
- 963497464,17,84,{ 151, 152, 153, 154, 155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166, 167, 168, 169, 170 },211,22,89,156,{ 223, 224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238, 239, 240, 241, 242, 243, 244, 245 }
- };
- mavlink_open_drone_id_authentication_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.timestamp = packet_in.timestamp;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.authentication_type = packet_in.authentication_type;
- packet1.data_page = packet_in.data_page;
- packet1.last_page_index = packet_in.last_page_index;
- packet1.length = packet_in.length;
-
- mav_array_memcpy(packet1.id_or_mac, packet_in.id_or_mac, sizeof(uint8_t)*20);
- mav_array_memcpy(packet1.authentication_data, packet_in.authentication_data, sizeof(uint8_t)*23);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_OPEN_DRONE_ID_AUTHENTICATION_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_OPEN_DRONE_ID_AUTHENTICATION_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_authentication_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_open_drone_id_authentication_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_authentication_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.authentication_type , packet1.data_page , packet1.last_page_index , packet1.length , packet1.timestamp , packet1.authentication_data );
- mavlink_msg_open_drone_id_authentication_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_authentication_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.authentication_type , packet1.data_page , packet1.last_page_index , packet1.length , packet1.timestamp , packet1.authentication_data );
- mavlink_msg_open_drone_id_authentication_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_open_drone_id_authentication_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_authentication_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.authentication_type , packet1.data_page , packet1.last_page_index , packet1.length , packet1.timestamp , packet1.authentication_data );
- mavlink_msg_open_drone_id_authentication_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("OPEN_DRONE_ID_AUTHENTICATION") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_OPEN_DRONE_ID_AUTHENTICATION) != NULL);
- #endif
- }
- static void mavlink_test_open_drone_id_self_id(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_OPEN_DRONE_ID_SELF_ID >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_open_drone_id_self_id_t packet_in = {
- 5,72,{ 139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154, 155, 156, 157, 158 },199,"XYZABCDEFGHIJKLMNOPQRS"
- };
- mavlink_open_drone_id_self_id_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.description_type = packet_in.description_type;
-
- mav_array_memcpy(packet1.id_or_mac, packet_in.id_or_mac, sizeof(uint8_t)*20);
- mav_array_memcpy(packet1.description, packet_in.description, sizeof(char)*23);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_OPEN_DRONE_ID_SELF_ID_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_OPEN_DRONE_ID_SELF_ID_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_self_id_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_open_drone_id_self_id_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_self_id_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.description_type , packet1.description );
- mavlink_msg_open_drone_id_self_id_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_self_id_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.description_type , packet1.description );
- mavlink_msg_open_drone_id_self_id_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_open_drone_id_self_id_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_self_id_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.description_type , packet1.description );
- mavlink_msg_open_drone_id_self_id_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("OPEN_DRONE_ID_SELF_ID") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_OPEN_DRONE_ID_SELF_ID) != NULL);
- #endif
- }
- static void mavlink_test_open_drone_id_system(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_OPEN_DRONE_ID_SYSTEM >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_open_drone_id_system_t packet_in = {
- 963497464,963497672,73.0,101.0,129.0,963498504,18483,18587,89,156,{ 223, 224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238, 239, 240, 241, 242 },27,94,161,228
- };
- mavlink_open_drone_id_system_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.operator_latitude = packet_in.operator_latitude;
- packet1.operator_longitude = packet_in.operator_longitude;
- packet1.area_ceiling = packet_in.area_ceiling;
- packet1.area_floor = packet_in.area_floor;
- packet1.operator_altitude_geo = packet_in.operator_altitude_geo;
- packet1.timestamp = packet_in.timestamp;
- packet1.area_count = packet_in.area_count;
- packet1.area_radius = packet_in.area_radius;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.operator_location_type = packet_in.operator_location_type;
- packet1.classification_type = packet_in.classification_type;
- packet1.category_eu = packet_in.category_eu;
- packet1.class_eu = packet_in.class_eu;
-
- mav_array_memcpy(packet1.id_or_mac, packet_in.id_or_mac, sizeof(uint8_t)*20);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_OPEN_DRONE_ID_SYSTEM_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_OPEN_DRONE_ID_SYSTEM_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_system_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_open_drone_id_system_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_system_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.operator_location_type , packet1.classification_type , packet1.operator_latitude , packet1.operator_longitude , packet1.area_count , packet1.area_radius , packet1.area_ceiling , packet1.area_floor , packet1.category_eu , packet1.class_eu , packet1.operator_altitude_geo , packet1.timestamp );
- mavlink_msg_open_drone_id_system_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_system_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.operator_location_type , packet1.classification_type , packet1.operator_latitude , packet1.operator_longitude , packet1.area_count , packet1.area_radius , packet1.area_ceiling , packet1.area_floor , packet1.category_eu , packet1.class_eu , packet1.operator_altitude_geo , packet1.timestamp );
- mavlink_msg_open_drone_id_system_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_open_drone_id_system_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_system_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.operator_location_type , packet1.classification_type , packet1.operator_latitude , packet1.operator_longitude , packet1.area_count , packet1.area_radius , packet1.area_ceiling , packet1.area_floor , packet1.category_eu , packet1.class_eu , packet1.operator_altitude_geo , packet1.timestamp );
- mavlink_msg_open_drone_id_system_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("OPEN_DRONE_ID_SYSTEM") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_OPEN_DRONE_ID_SYSTEM) != NULL);
- #endif
- }
- static void mavlink_test_open_drone_id_operator_id(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_OPEN_DRONE_ID_OPERATOR_ID >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_open_drone_id_operator_id_t packet_in = {
- 5,72,{ 139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154, 155, 156, 157, 158 },199,"XYZABCDEFGHIJKLMNOP"
- };
- mavlink_open_drone_id_operator_id_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.operator_id_type = packet_in.operator_id_type;
-
- mav_array_memcpy(packet1.id_or_mac, packet_in.id_or_mac, sizeof(uint8_t)*20);
- mav_array_memcpy(packet1.operator_id, packet_in.operator_id, sizeof(char)*20);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_OPEN_DRONE_ID_OPERATOR_ID_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_OPEN_DRONE_ID_OPERATOR_ID_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_operator_id_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_open_drone_id_operator_id_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_operator_id_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.operator_id_type , packet1.operator_id );
- mavlink_msg_open_drone_id_operator_id_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_operator_id_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.operator_id_type , packet1.operator_id );
- mavlink_msg_open_drone_id_operator_id_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_open_drone_id_operator_id_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_operator_id_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.operator_id_type , packet1.operator_id );
- mavlink_msg_open_drone_id_operator_id_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("OPEN_DRONE_ID_OPERATOR_ID") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_OPEN_DRONE_ID_OPERATOR_ID) != NULL);
- #endif
- }
- static void mavlink_test_open_drone_id_message_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_OPEN_DRONE_ID_MESSAGE_PACK >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_open_drone_id_message_pack_t packet_in = {
- 5,72,{ 139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154, 155, 156, 157, 158 },199,10,{ 77, 78, 79, 80, 81, 82, 83, 84, 85, 86, 87, 88, 89, 90, 91, 92, 93, 94, 95, 96, 97, 98, 99, 100, 101, 102, 103, 104, 105, 106, 107, 108, 109, 110, 111, 112, 113, 114, 115, 116, 117, 118, 119, 120, 121, 122, 123, 124, 125, 126, 127, 128, 129, 130, 131, 132, 133, 134, 135, 136, 137, 138, 139, 140, 141, 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154, 155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166, 167, 168, 169, 170, 171, 172, 173, 174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184, 185, 186, 187, 188, 189, 190, 191, 192, 193, 194, 195, 196, 197, 198, 199, 200, 201, 202, 203, 204, 205, 206, 207, 208, 209, 210, 211, 212, 213, 214, 215, 216, 217, 218, 219, 220, 221, 222, 223, 224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238, 239, 240, 241, 242, 243, 244, 245, 246, 247, 248, 249, 250, 251, 252, 253, 254, 255, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45 }
- };
- mavlink_open_drone_id_message_pack_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
- packet1.single_message_size = packet_in.single_message_size;
- packet1.msg_pack_size = packet_in.msg_pack_size;
-
- mav_array_memcpy(packet1.id_or_mac, packet_in.id_or_mac, sizeof(uint8_t)*20);
- mav_array_memcpy(packet1.messages, packet_in.messages, sizeof(uint8_t)*225);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_OPEN_DRONE_ID_MESSAGE_PACK_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_OPEN_DRONE_ID_MESSAGE_PACK_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_message_pack_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_open_drone_id_message_pack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_message_pack_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.single_message_size , packet1.msg_pack_size , packet1.messages );
- mavlink_msg_open_drone_id_message_pack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_message_pack_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.single_message_size , packet1.msg_pack_size , packet1.messages );
- mavlink_msg_open_drone_id_message_pack_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_open_drone_id_message_pack_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_message_pack_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.id_or_mac , packet1.single_message_size , packet1.msg_pack_size , packet1.messages );
- mavlink_msg_open_drone_id_message_pack_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("OPEN_DRONE_ID_MESSAGE_PACK") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_OPEN_DRONE_ID_MESSAGE_PACK) != NULL);
- #endif
- }
- static void mavlink_test_open_drone_id_arm_status(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_OPEN_DRONE_ID_ARM_STATUS >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_open_drone_id_arm_status_t packet_in = {
- 5,"BCDEFGHIJKLMNOPQRSTUVWXYZABCDEFGHIJKLMNOPQRSTUVWX"
- };
- mavlink_open_drone_id_arm_status_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.status = packet_in.status;
-
- mav_array_memcpy(packet1.error, packet_in.error, sizeof(char)*50);
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_OPEN_DRONE_ID_ARM_STATUS_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_OPEN_DRONE_ID_ARM_STATUS_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_arm_status_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_open_drone_id_arm_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_arm_status_pack(system_id, component_id, &msg , packet1.status , packet1.error );
- mavlink_msg_open_drone_id_arm_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_arm_status_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.status , packet1.error );
- mavlink_msg_open_drone_id_arm_status_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_open_drone_id_arm_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_arm_status_send(MAVLINK_COMM_1 , packet1.status , packet1.error );
- mavlink_msg_open_drone_id_arm_status_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("OPEN_DRONE_ID_ARM_STATUS") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_OPEN_DRONE_ID_ARM_STATUS) != NULL);
- #endif
- }
- static void mavlink_test_open_drone_id_system_update(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_OPEN_DRONE_ID_SYSTEM_UPDATE >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_open_drone_id_system_update_t packet_in = {
- 963497464,963497672,73.0,963498088,53,120
- };
- mavlink_open_drone_id_system_update_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.operator_latitude = packet_in.operator_latitude;
- packet1.operator_longitude = packet_in.operator_longitude;
- packet1.operator_altitude_geo = packet_in.operator_altitude_geo;
- packet1.timestamp = packet_in.timestamp;
- packet1.target_system = packet_in.target_system;
- packet1.target_component = packet_in.target_component;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_OPEN_DRONE_ID_SYSTEM_UPDATE_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_OPEN_DRONE_ID_SYSTEM_UPDATE_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_system_update_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_open_drone_id_system_update_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_system_update_pack(system_id, component_id, &msg , packet1.target_system , packet1.target_component , packet1.operator_latitude , packet1.operator_longitude , packet1.operator_altitude_geo , packet1.timestamp );
- mavlink_msg_open_drone_id_system_update_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_system_update_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.target_system , packet1.target_component , packet1.operator_latitude , packet1.operator_longitude , packet1.operator_altitude_geo , packet1.timestamp );
- mavlink_msg_open_drone_id_system_update_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_open_drone_id_system_update_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_open_drone_id_system_update_send(MAVLINK_COMM_1 , packet1.target_system , packet1.target_component , packet1.operator_latitude , packet1.operator_longitude , packet1.operator_altitude_geo , packet1.timestamp );
- mavlink_msg_open_drone_id_system_update_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("OPEN_DRONE_ID_SYSTEM_UPDATE") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_OPEN_DRONE_ID_SYSTEM_UPDATE) != NULL);
- #endif
- }
- static void mavlink_test_hygrometer_sensor(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- mavlink_status_t *status = mavlink_get_channel_status(MAVLINK_COMM_0);
- if ((status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) && MAVLINK_MSG_ID_HYGROMETER_SENSOR >= 256) {
- return;
- }
- #endif
- mavlink_message_t msg;
- uint8_t buffer[MAVLINK_MAX_PACKET_LEN];
- uint16_t i;
- mavlink_hygrometer_sensor_t packet_in = {
- 17235,17339,17
- };
- mavlink_hygrometer_sensor_t packet1, packet2;
- memset(&packet1, 0, sizeof(packet1));
- packet1.temperature = packet_in.temperature;
- packet1.humidity = packet_in.humidity;
- packet1.id = packet_in.id;
-
-
- #ifdef MAVLINK_STATUS_FLAG_OUT_MAVLINK1
- if (status->flags & MAVLINK_STATUS_FLAG_OUT_MAVLINK1) {
- // cope with extensions
- memset(MAVLINK_MSG_ID_HYGROMETER_SENSOR_MIN_LEN + (char *)&packet1, 0, sizeof(packet1)-MAVLINK_MSG_ID_HYGROMETER_SENSOR_MIN_LEN);
- }
- #endif
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hygrometer_sensor_encode(system_id, component_id, &msg, &packet1);
- mavlink_msg_hygrometer_sensor_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hygrometer_sensor_pack(system_id, component_id, &msg , packet1.id , packet1.temperature , packet1.humidity );
- mavlink_msg_hygrometer_sensor_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hygrometer_sensor_pack_chan(system_id, component_id, MAVLINK_COMM_0, &msg , packet1.id , packet1.temperature , packet1.humidity );
- mavlink_msg_hygrometer_sensor_decode(&msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_to_send_buffer(buffer, &msg);
- for (i=0; i<mavlink_msg_get_send_buffer_length(&msg); i++) {
- comm_send_ch(MAVLINK_COMM_0, buffer[i]);
- }
- mavlink_msg_hygrometer_sensor_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
-
- memset(&packet2, 0, sizeof(packet2));
- mavlink_msg_hygrometer_sensor_send(MAVLINK_COMM_1 , packet1.id , packet1.temperature , packet1.humidity );
- mavlink_msg_hygrometer_sensor_decode(last_msg, &packet2);
- MAVLINK_ASSERT(memcmp(&packet1, &packet2, sizeof(packet1)) == 0);
- #ifdef MAVLINK_HAVE_GET_MESSAGE_INFO
- MAVLINK_ASSERT(mavlink_get_message_info_by_name("HYGROMETER_SENSOR") != NULL);
- MAVLINK_ASSERT(mavlink_get_message_info_by_id(MAVLINK_MSG_ID_HYGROMETER_SENSOR) != NULL);
- #endif
- }
- static void mavlink_test_common(uint8_t system_id, uint8_t component_id, mavlink_message_t *last_msg)
- {
- mavlink_test_sys_status(system_id, component_id, last_msg);
- mavlink_test_system_time(system_id, component_id, last_msg);
- mavlink_test_ping(system_id, component_id, last_msg);
- mavlink_test_change_operator_control(system_id, component_id, last_msg);
- mavlink_test_change_operator_control_ack(system_id, component_id, last_msg);
- mavlink_test_auth_key(system_id, component_id, last_msg);
- mavlink_test_link_node_status(system_id, component_id, last_msg);
- mavlink_test_set_mode(system_id, component_id, last_msg);
- mavlink_test_param_request_read(system_id, component_id, last_msg);
- mavlink_test_param_request_list(system_id, component_id, last_msg);
- mavlink_test_param_value(system_id, component_id, last_msg);
- mavlink_test_param_set(system_id, component_id, last_msg);
- mavlink_test_gps_raw_int(system_id, component_id, last_msg);
- mavlink_test_gps_status(system_id, component_id, last_msg);
- mavlink_test_scaled_imu(system_id, component_id, last_msg);
- mavlink_test_raw_imu(system_id, component_id, last_msg);
- mavlink_test_raw_pressure(system_id, component_id, last_msg);
- mavlink_test_scaled_pressure(system_id, component_id, last_msg);
- mavlink_test_attitude(system_id, component_id, last_msg);
- mavlink_test_attitude_quaternion(system_id, component_id, last_msg);
- mavlink_test_local_position_ned(system_id, component_id, last_msg);
- mavlink_test_global_position_int(system_id, component_id, last_msg);
- mavlink_test_rc_channels_scaled(system_id, component_id, last_msg);
- mavlink_test_rc_channels_raw(system_id, component_id, last_msg);
- mavlink_test_servo_output_raw(system_id, component_id, last_msg);
- mavlink_test_mission_request_partial_list(system_id, component_id, last_msg);
- mavlink_test_mission_write_partial_list(system_id, component_id, last_msg);
- mavlink_test_mission_item(system_id, component_id, last_msg);
- mavlink_test_mission_request(system_id, component_id, last_msg);
- mavlink_test_mission_set_current(system_id, component_id, last_msg);
- mavlink_test_mission_current(system_id, component_id, last_msg);
- mavlink_test_mission_request_list(system_id, component_id, last_msg);
- mavlink_test_mission_count(system_id, component_id, last_msg);
- mavlink_test_mission_clear_all(system_id, component_id, last_msg);
- mavlink_test_mission_item_reached(system_id, component_id, last_msg);
- mavlink_test_mission_ack(system_id, component_id, last_msg);
- mavlink_test_set_gps_global_origin(system_id, component_id, last_msg);
- mavlink_test_gps_global_origin(system_id, component_id, last_msg);
- mavlink_test_param_map_rc(system_id, component_id, last_msg);
- mavlink_test_mission_request_int(system_id, component_id, last_msg);
- mavlink_test_safety_set_allowed_area(system_id, component_id, last_msg);
- mavlink_test_safety_allowed_area(system_id, component_id, last_msg);
- mavlink_test_attitude_quaternion_cov(system_id, component_id, last_msg);
- mavlink_test_nav_controller_output(system_id, component_id, last_msg);
- mavlink_test_global_position_int_cov(system_id, component_id, last_msg);
- mavlink_test_local_position_ned_cov(system_id, component_id, last_msg);
- mavlink_test_rc_channels(system_id, component_id, last_msg);
- mavlink_test_request_data_stream(system_id, component_id, last_msg);
- mavlink_test_data_stream(system_id, component_id, last_msg);
- mavlink_test_manual_control(system_id, component_id, last_msg);
- mavlink_test_rc_channels_override(system_id, component_id, last_msg);
- mavlink_test_mission_item_int(system_id, component_id, last_msg);
- mavlink_test_vfr_hud(system_id, component_id, last_msg);
- mavlink_test_command_int(system_id, component_id, last_msg);
- mavlink_test_command_long(system_id, component_id, last_msg);
- mavlink_test_command_ack(system_id, component_id, last_msg);
- mavlink_test_command_cancel(system_id, component_id, last_msg);
- mavlink_test_manual_setpoint(system_id, component_id, last_msg);
- mavlink_test_set_attitude_target(system_id, component_id, last_msg);
- mavlink_test_attitude_target(system_id, component_id, last_msg);
- mavlink_test_set_position_target_local_ned(system_id, component_id, last_msg);
- mavlink_test_position_target_local_ned(system_id, component_id, last_msg);
- mavlink_test_set_position_target_global_int(system_id, component_id, last_msg);
- mavlink_test_position_target_global_int(system_id, component_id, last_msg);
- mavlink_test_local_position_ned_system_global_offset(system_id, component_id, last_msg);
- mavlink_test_hil_state(system_id, component_id, last_msg);
- mavlink_test_hil_controls(system_id, component_id, last_msg);
- mavlink_test_hil_rc_inputs_raw(system_id, component_id, last_msg);
- mavlink_test_hil_actuator_controls(system_id, component_id, last_msg);
- mavlink_test_optical_flow(system_id, component_id, last_msg);
- mavlink_test_global_vision_position_estimate(system_id, component_id, last_msg);
- mavlink_test_vision_position_estimate(system_id, component_id, last_msg);
- mavlink_test_vision_speed_estimate(system_id, component_id, last_msg);
- mavlink_test_vicon_position_estimate(system_id, component_id, last_msg);
- mavlink_test_highres_imu(system_id, component_id, last_msg);
- mavlink_test_optical_flow_rad(system_id, component_id, last_msg);
- mavlink_test_hil_sensor(system_id, component_id, last_msg);
- mavlink_test_sim_state(system_id, component_id, last_msg);
- mavlink_test_radio_status(system_id, component_id, last_msg);
- mavlink_test_file_transfer_protocol(system_id, component_id, last_msg);
- mavlink_test_timesync(system_id, component_id, last_msg);
- mavlink_test_camera_trigger(system_id, component_id, last_msg);
- mavlink_test_hil_gps(system_id, component_id, last_msg);
- mavlink_test_hil_optical_flow(system_id, component_id, last_msg);
- mavlink_test_hil_state_quaternion(system_id, component_id, last_msg);
- mavlink_test_scaled_imu2(system_id, component_id, last_msg);
- mavlink_test_log_request_list(system_id, component_id, last_msg);
- mavlink_test_log_entry(system_id, component_id, last_msg);
- mavlink_test_log_request_data(system_id, component_id, last_msg);
- mavlink_test_log_data(system_id, component_id, last_msg);
- mavlink_test_log_erase(system_id, component_id, last_msg);
- mavlink_test_log_request_end(system_id, component_id, last_msg);
- mavlink_test_gps_inject_data(system_id, component_id, last_msg);
- mavlink_test_gps2_raw(system_id, component_id, last_msg);
- mavlink_test_power_status(system_id, component_id, last_msg);
- mavlink_test_serial_control(system_id, component_id, last_msg);
- mavlink_test_gps_rtk(system_id, component_id, last_msg);
- mavlink_test_gps2_rtk(system_id, component_id, last_msg);
- mavlink_test_scaled_imu3(system_id, component_id, last_msg);
- mavlink_test_data_transmission_handshake(system_id, component_id, last_msg);
- mavlink_test_encapsulated_data(system_id, component_id, last_msg);
- mavlink_test_distance_sensor(system_id, component_id, last_msg);
- mavlink_test_terrain_request(system_id, component_id, last_msg);
- mavlink_test_terrain_data(system_id, component_id, last_msg);
- mavlink_test_terrain_check(system_id, component_id, last_msg);
- mavlink_test_terrain_report(system_id, component_id, last_msg);
- mavlink_test_scaled_pressure2(system_id, component_id, last_msg);
- mavlink_test_att_pos_mocap(system_id, component_id, last_msg);
- mavlink_test_set_actuator_control_target(system_id, component_id, last_msg);
- mavlink_test_actuator_control_target(system_id, component_id, last_msg);
- mavlink_test_altitude(system_id, component_id, last_msg);
- mavlink_test_resource_request(system_id, component_id, last_msg);
- mavlink_test_scaled_pressure3(system_id, component_id, last_msg);
- mavlink_test_follow_target(system_id, component_id, last_msg);
- mavlink_test_control_system_state(system_id, component_id, last_msg);
- mavlink_test_battery_status(system_id, component_id, last_msg);
- mavlink_test_autopilot_version(system_id, component_id, last_msg);
- mavlink_test_landing_target(system_id, component_id, last_msg);
- mavlink_test_fence_status(system_id, component_id, last_msg);
- mavlink_test_mag_cal_report(system_id, component_id, last_msg);
- mavlink_test_efi_status(system_id, component_id, last_msg);
- mavlink_test_estimator_status(system_id, component_id, last_msg);
- mavlink_test_wind_cov(system_id, component_id, last_msg);
- mavlink_test_gps_input(system_id, component_id, last_msg);
- mavlink_test_gps_rtcm_data(system_id, component_id, last_msg);
- mavlink_test_high_latency(system_id, component_id, last_msg);
- mavlink_test_high_latency2(system_id, component_id, last_msg);
- mavlink_test_vibration(system_id, component_id, last_msg);
- mavlink_test_home_position(system_id, component_id, last_msg);
- mavlink_test_set_home_position(system_id, component_id, last_msg);
- mavlink_test_message_interval(system_id, component_id, last_msg);
- mavlink_test_extended_sys_state(system_id, component_id, last_msg);
- mavlink_test_adsb_vehicle(system_id, component_id, last_msg);
- mavlink_test_collision(system_id, component_id, last_msg);
- mavlink_test_v2_extension(system_id, component_id, last_msg);
- mavlink_test_memory_vect(system_id, component_id, last_msg);
- mavlink_test_debug_vect(system_id, component_id, last_msg);
- mavlink_test_named_value_float(system_id, component_id, last_msg);
- mavlink_test_named_value_int(system_id, component_id, last_msg);
- mavlink_test_statustext(system_id, component_id, last_msg);
- mavlink_test_debug(system_id, component_id, last_msg);
- mavlink_test_setup_signing(system_id, component_id, last_msg);
- mavlink_test_button_change(system_id, component_id, last_msg);
- mavlink_test_play_tune(system_id, component_id, last_msg);
- mavlink_test_camera_information(system_id, component_id, last_msg);
- mavlink_test_camera_settings(system_id, component_id, last_msg);
- mavlink_test_storage_information(system_id, component_id, last_msg);
- mavlink_test_camera_capture_status(system_id, component_id, last_msg);
- mavlink_test_camera_image_captured(system_id, component_id, last_msg);
- mavlink_test_flight_information(system_id, component_id, last_msg);
- mavlink_test_mount_orientation(system_id, component_id, last_msg);
- mavlink_test_logging_data(system_id, component_id, last_msg);
- mavlink_test_logging_data_acked(system_id, component_id, last_msg);
- mavlink_test_logging_ack(system_id, component_id, last_msg);
- mavlink_test_video_stream_information(system_id, component_id, last_msg);
- mavlink_test_video_stream_status(system_id, component_id, last_msg);
- mavlink_test_camera_fov_status(system_id, component_id, last_msg);
- mavlink_test_camera_tracking_image_status(system_id, component_id, last_msg);
- mavlink_test_camera_tracking_geo_status(system_id, component_id, last_msg);
- mavlink_test_gimbal_manager_information(system_id, component_id, last_msg);
- mavlink_test_gimbal_manager_status(system_id, component_id, last_msg);
- mavlink_test_gimbal_manager_set_attitude(system_id, component_id, last_msg);
- mavlink_test_gimbal_device_information(system_id, component_id, last_msg);
- mavlink_test_gimbal_device_set_attitude(system_id, component_id, last_msg);
- mavlink_test_gimbal_device_attitude_status(system_id, component_id, last_msg);
- mavlink_test_autopilot_state_for_gimbal_device(system_id, component_id, last_msg);
- mavlink_test_gimbal_manager_set_pitchyaw(system_id, component_id, last_msg);
- mavlink_test_gimbal_manager_set_manual_control(system_id, component_id, last_msg);
- mavlink_test_esc_info(system_id, component_id, last_msg);
- mavlink_test_esc_status(system_id, component_id, last_msg);
- mavlink_test_wifi_config_ap(system_id, component_id, last_msg);
- mavlink_test_ais_vessel(system_id, component_id, last_msg);
- mavlink_test_uavcan_node_status(system_id, component_id, last_msg);
- mavlink_test_uavcan_node_info(system_id, component_id, last_msg);
- mavlink_test_param_ext_request_read(system_id, component_id, last_msg);
- mavlink_test_param_ext_request_list(system_id, component_id, last_msg);
- mavlink_test_param_ext_value(system_id, component_id, last_msg);
- mavlink_test_param_ext_set(system_id, component_id, last_msg);
- mavlink_test_param_ext_ack(system_id, component_id, last_msg);
- mavlink_test_obstacle_distance(system_id, component_id, last_msg);
- mavlink_test_odometry(system_id, component_id, last_msg);
- mavlink_test_trajectory_representation_waypoints(system_id, component_id, last_msg);
- mavlink_test_trajectory_representation_bezier(system_id, component_id, last_msg);
- mavlink_test_cellular_status(system_id, component_id, last_msg);
- mavlink_test_isbd_link_status(system_id, component_id, last_msg);
- mavlink_test_cellular_config(system_id, component_id, last_msg);
- mavlink_test_raw_rpm(system_id, component_id, last_msg);
- mavlink_test_utm_global_position(system_id, component_id, last_msg);
- mavlink_test_debug_float_array(system_id, component_id, last_msg);
- mavlink_test_orbit_execution_status(system_id, component_id, last_msg);
- mavlink_test_battery_info(system_id, component_id, last_msg);
- mavlink_test_generator_status(system_id, component_id, last_msg);
- mavlink_test_actuator_output_status(system_id, component_id, last_msg);
- mavlink_test_time_estimate_to_target(system_id, component_id, last_msg);
- mavlink_test_tunnel(system_id, component_id, last_msg);
- mavlink_test_can_frame(system_id, component_id, last_msg);
- mavlink_test_onboard_computer_status(system_id, component_id, last_msg);
- mavlink_test_component_information(system_id, component_id, last_msg);
- mavlink_test_component_metadata(system_id, component_id, last_msg);
- mavlink_test_play_tune_v2(system_id, component_id, last_msg);
- mavlink_test_supported_tunes(system_id, component_id, last_msg);
- mavlink_test_event(system_id, component_id, last_msg);
- mavlink_test_current_event_sequence(system_id, component_id, last_msg);
- mavlink_test_request_event(system_id, component_id, last_msg);
- mavlink_test_response_event_error(system_id, component_id, last_msg);
- mavlink_test_canfd_frame(system_id, component_id, last_msg);
- mavlink_test_can_filter_modify(system_id, component_id, last_msg);
- mavlink_test_wheel_distance(system_id, component_id, last_msg);
- mavlink_test_winch_status(system_id, component_id, last_msg);
- mavlink_test_open_drone_id_basic_id(system_id, component_id, last_msg);
- mavlink_test_open_drone_id_location(system_id, component_id, last_msg);
- mavlink_test_open_drone_id_authentication(system_id, component_id, last_msg);
- mavlink_test_open_drone_id_self_id(system_id, component_id, last_msg);
- mavlink_test_open_drone_id_system(system_id, component_id, last_msg);
- mavlink_test_open_drone_id_operator_id(system_id, component_id, last_msg);
- mavlink_test_open_drone_id_message_pack(system_id, component_id, last_msg);
- mavlink_test_open_drone_id_arm_status(system_id, component_id, last_msg);
- mavlink_test_open_drone_id_system_update(system_id, component_id, last_msg);
- mavlink_test_hygrometer_sensor(system_id, component_id, last_msg);
- }
- #ifdef __cplusplus
- }
- #endif // __cplusplus
- #endif // COMMON_TESTSUITE_H
|