| /branches/salvo_gps/Basis_v0067g/tags/v0002/Flight-Ctrl_MEGA644_V0_01a.hex |
|---|
| 0,0 → 1,2321 |
| :100000000C946C020C9489020C9489020C94890261 |
| :100010000C9489020C9489020C9489020C94890234 |
| :100020000C9489020C94890C0C9489020C9489021A |
| :100030000C949B150C9489020C9489020C948902EF |
| :100040000C9489020C9489020C94920B0C948902F2 |
| :100050000C94BA070C9489020C94D2040C94890273 |
| :100060000C94850D0C9489020C94D0140C94890284 |
| :100070000A0A0D004E65757472616C004865616412 |
| :10008000696E67486F6C64000A0D5374657565721C |
| :10009000756E673A20004F4B0A0D000A0D416267EA |
| :1000A0006C65696368204C756674647275636B7304 |
| :1000B000656E736F722E2E000A0D42656E75747A2E |
| :1000C0006520506172616D657465727361747A2028 |
| :1000D0002564000A0D414343206E69636874206102 |
| :1000E000626765676C696368656E21000A0D496E19 |
| :1000F00069742E20454550524F4D3A2047656E6534 |
| :1001000072696572652044656661756C742D506115 |
| :1001100072616D657465722E2E2E000A0D3D3D3D97 |
| :100120003D3D3D3D3D3D3D3D3D3D3D3D3D3D3D3DFF |
| :100130003D3D3D3D3D3D3D3D3D3D3D000A0D466C57 |
| :1001400069676874436F6E74726F6C0A0D486172F0 |
| :1001500064776172653A25642E25640A0D536F66D3 |
| :1001600074776172653A5625642E256425632000F4 |
| :100170002E0052616E67653A2533692D253369007B |
| :100180005374656C6C756E673A202533690053654E |
| :1001900074706F696E742020253369005365727620 |
| :1001A0006F202000506F7469343A20202533690095 |
| :1001B000506F7469333A202025336900506F746999 |
| :1001C000323A202025336900506F7469313A20207B |
| :1001D0002533690053746172743A20202020202551 |
| :1001E0003569004D657373776572743A2020253543 |
| :1001F00069005269636874756E673A202025356915 |
| :10020000004B6F6D70617373202020202020200030 |
| :10021000456D70662E506567656C3A2535690053EB |
| :1002200070616E6E756E673A202025356900486FE3 |
| :1002300063682025346920282533692900526F6CB2 |
| :100240006C20253469202825336929004E69636BA9 |
| :100250002025346920282533692900414343202D76 |
| :100260002053656E736F720047696572202534698B |
| :1002700020282533692900526F6C6C2025346920B1 |
| :100280002825336929004E69636B202534692028AD |
| :10029000253369290047696572202534692028259E |
| :1002A00033692900526F6C6C20253469202825336E |
| :1002B0006929004E69636B2025346920282533693C |
| :1002C00029004779726F202D2053656E736F72007D |
| :1002D00050333A253469202050343A2534692000BF |
| :1002E00050313A253469202050323A2534692000B3 |
| :1002F00047733A253469202047693A25346920003C |
| :100300004E693A2534692020526F3A25346920001D |
| :100310004B373A25346920204B383A253469200080 |
| :100320004B353A25346920204B363A253469200074 |
| :100330004B333A25346920204B343A253469200068 |
| :100340004B313A25346920204B323A25346920005C |
| :100350004B6F6D706173733A202020253569005210 |
| :100360006F6C6C3A202020202020253569004E69D2 |
| :10037000636B3A20202020202025356900616B74B2 |
| :100380002E204C6167650048F668656E726567658A |
| :100390006C756E67004B65696E6520004F66662060 |
| :1003A00020202020203A20253569004C7566746491 |
| :1003B0007275636B3A2025356900536F6C6C486F1A |
| :1003C0006568653A2025356900486F6568653A209B |
| :1003D000202020202535690028632920486F6C677C |
| :1003E000657220427573730053657474696E673A61 |
| :1003F000202564200048573A5625642E2564205352 |
| :10040000573A25642E25642563002B2B204D696BFC |
| :10041000726F4B6F70746572202B2B005B25695DCA |
| :100420000000001100230034004600570069007AE4 |
| :10043000008B009C00AE00BF00D000E100F2000382 |
| :100440000114012401350146015601660177018737 |
| :10045000019701A701B601C601D501E501F4010329 |
| :1004600002120221022F023E024C025A0268027559 |
| :1004700002830290029D02AA02B702C302CF02DBEE |
| :1004800002E702F302FE02090314031F03290333E8 |
| :10049000033D0347035003590362036B0373037B5C |
| :1004A0000383038A03920399039F03A603AC03B259 |
| :1004B00003B703BC03C103C603CA03CE03D203D6EA |
| :1004C00003D903DC03DE03E103E303E403E603E70C |
| :1004D00003E703E803E8030011241FBECFEFD0E1D8 |
| :1004E000DEBFCDBF13E0A0E0B1E0ECE4FEE802C067 |
| :1004F00005900D92A23AB107D9F718E0A2EAB3E04D |
| :1005000001C01D92AB38B107E1F70E94C8020C94FC |
| :1005100025470C94000022E030E0D9010E941147E9 |
| :10052000802D863028F082E0D901082E0E941947DC |
| :1005300099270895FB01282F863008F025E0842FA5 |
| :100540009927429FD0011124AC59BF4F019724F045 |
| :1005500001900E941947FACFA2E0B0E0022E0E945B |
| :1005600019470895CF93DF93FB01C42FDD27863011 |
| :1005700008F085E0489FD0011124AC59BF4F219766 |
| :1005800024F00E9411470192FACFDF91CF91089594 |
| :100590001F93CF93DF9314B815B8189B02C08BE05C |
| :1005A00001C08AE0809300018DEC87B98FEF88B994 |
| :1005B0008BE184B981E085B98EE38AB9579A87EFD8 |
| :1005C0008BB984B7877F84BF8091600088618093F6 |
| :1005D00060001092600080ED97E09093C5038093D7 |
| :1005E000C4031092640410926304109235071092B1 |
| :1005F0003407109262041092610410926004109209 |
| :100600005F04809100018A3011F4289801C0289A73 |
| :100610000E94300D0E940D060E9486150E947F0DDB |
| :100620000E94B61478941092330681E080933406C9 |
| :1006300087E0809335062091000181E690E09F934A |
| :100640008F9381E090E09F938F931F921F92822F50 |
| :100650006AE00E94A146892F99279F938F93822F4A |
| :100660000E94A14699279F938F938CE391E09F93DB |
| :100670008F931F920E94F0088BE191E09F938F93DC |
| :100680001F920E94F008299AA1E0B0E00E94114751 |
| :10069000802D2DB73EB7205F3F4F0FB6F8943EBF79 |
| :1006A0000FBE2DBF843409F43FC08CEE90E09F93C1 |
| :1006B0008F931F920E94F0080E94E12310E00F9098 |
| :1006C0000F900F90123049F40E94502347E46EE5DA |
| :1006D00077E082E00E949A0202C0133051F40E9437 |
| :1006E000C02247E46EE577E083E00E949A0214E0BE |
| :1006F00002C0143010F00E94502347E46EE577E00A |
| :10070000812F0E949A021F5F1630E0F283E022E000 |
| :1007100030E0D901082E0E94194784E4215030406E |
| :10072000D901082E0E941947C4E0D0E0DE010E94E2 |
| :100730001147802D853050F083ED90E09F938F938B |
| :100740001F920E94F0080F900F900F902297DE01E9 |
| :100750000E941147802D863028F082E0DE01082EAD |
| :100760000E94194747E46EE577E00E94B202DE017D |
| :100770000E941147802D863028F082E0DE01082E8D |
| :100780000E94194799279F938F9388EB90E09F933E |
| :100790008F931F920E94F008809166070F900F9030 |
| :1007A0000F900F900F9080FD03C0C8EED3E020C0E3 |
| :1007B0008BE990E09F938F931F920E94F00888EE40 |
| :1007C00093E00E94740CEC010E9421100F900F9096 |
| :1007D0000F90CE010E947D0C8823D9F386E990E02A |
| :1007E0009F938F931F920E94F0080F900F900F908D |
| :1007F0000E943221809100018A3011F4289801C0B2 |
| :10080000289A469880ED97E09093C5038093C4039F |
| :1008100088EE93E090932E0680932D0685E58093D5 |
| :10082000280688E890E09F938F931F920E94F0081B |
| :10083000809166070F900F900F9082FF03C08CE7A6 |
| :1008400090E002C084E790E09F938F931F920E94F4 |
| :10085000F0080F900F900F9080E790E09F938F9398 |
| :100860001F920E94F0080E94651088E893E190931F |
| :100870008603809385030F900F900F908091C103A2 |
| :10088000882309F462C01092C1030E9471240E945F |
| :10089000EB20209100012A3011F4289801C0289AF9 |
| :1008A00080910301882321F081508093030110C0BF |
| :1008B0001092B2031092B30310927F0410927E0440 |
| :1008C000109281041092800410928304109282048A |
| :1008D00080915E04882329F080915E04815080938A |
| :1008E0005E048091850390918603892B01F585E054 |
| :1008F00090E090938603809385030E946015809119 |
| :100900000403909105038F5F9F4FF9F48091650474 |
| :100910008823D9F080E197E29093C5038093C403C4 |
| :1009200080E890E090930503809304030EC08091CB |
| :1009300085039091860301979093860380938503A6 |
| :100940002A3011F4289801C0289A0E9428060E9493 |
| :10095000C106CE010E947D0C882309F48FCF20911F |
| :1009600008033091090380917607992728173907E2 |
| :100970009CF480910403909105038F5F9F4F61F475 |
| :1009800080E797E19093C5038093C40380E093E0F0 |
| :10099000909305038093040384E690E00E94740C16 |
| :1009A000EC016CCF1F920F920FB60F9211248F9310 |
| :1009B0009F93EF93FF93809101018823E1F480914D |
| :1009C000BD039091BE0301969093BE038093BD0337 |
| :1009D000FC01E650FB4FE081ED3019F086399105BE |
| :1009E00039F41092BE031092BD0381E0809301019F |
| :1009F000E093C60004C01092BE031092BD03FF91A5 |
| :100A0000EF919F918F910F900FBE0F901F901895AF |
| :100A1000DC0120E030E040E050E0EAEFF4E005C027 |
| :100A20008191280F311D4F5F5F4F4A175B07C1F758 |
| :100A30003F70C90136E0969587953A95E1F7835C5A |
| :100A4000FD01E650FB4F808311962F73235CFD015F |
| :100A5000E650FB4F2083A550BB4F8DE08C93109246 |
| :100A600001018091FA048093C6000895EF92FF92ED |
| :100A70000F931F93CF93DF937A01722F93E290939A |
| :100A8000FA046093FB048093FC0403E010E060E050 |
| :100A9000ADEFB4E046C0F701E60FF11D90816F5F46 |
| :100AA000715019F4E0E040E00FC0F701E60FF11DCE |
| :100AB00040816F5F715011F4E0E006C0F701E60F6E |
| :100AC000F11DE0816F5F7150892F86958695835C5B |
| :100AD0008C935527892F99278370907024E0880F75 |
| :100AE000991F2A95E1F79A0194E0369527959A95F2 |
| :100AF000E1F7822B835CED0189834F705070440FC6 |
| :100B0000551F440F551F8E2F8295869586958370AD |
| :100B1000842B835C8A83EF73E35CEB830C5F1F4F52 |
| :100B20001496772309F0B7CFC8010E940805DF911A |
| :100B3000CF911F910F91FF90EF9008950F931F9306 |
| :100B4000CF93DF93EC01062F70E0A22FBB27129703 |
| :100B50004AC0E42FFF27E35CF94F30814F5FE42F59 |
| :100B6000FF27E35CF94F50814F5FE42FFF27E35CE1 |
| :100B7000F94F10814F5FE42FFF27E35CF94F20818D |
| :100B80004F5F842F9927A817B90784F1701771F167 |
| :100B90005D53FE01E70FF11D3D53330F330F852FDA |
| :100BA00082958F70382B3083613001F1912F9D53E6 |
| :100BB0007F5FFE01E70FF11D71505295507F892F25 |
| :100BC00086958695582B508363506F3F79F07E5FF2 |
| :100BD000FE01E70FF11D9295990F990F907C2D530F |
| :100BE000922B90837F5F662309F0B3CFDF91CF9183 |
| :100BF0001F910F9108951F93182F8A3019F48DE0DB |
| :100C00000E94FB058091C00085FFFCCF1093C600B9 |
| :100C100080E090E01F9108950895E1ECF0E088E114 |
| :100C20008083A0ECB0E08C9182608C93808180689E |
| :100C300080838081806480838AE28093C40088EC12 |
| :100C400090E00E94740C90932706809326060895E6 |
| :100C500080910101882309F493C08091A203882325 |
| :100C600071F080910101882351F02BE048E256E0B9 |
| :100C70006091F90487E40E9436051092A2038091E6 |
| :100C80002606909127060E947D0C882321F48091EE |
| :100C9000A4038823F9F0809101018823D9F022E48C |
| :100CA00043ED56E06091F90484E40E943605109209 |
| :100CB000A4038091B5039091B60301969093B60377 |
| :100CC0008093B5038AEF90E00E94740C90932706FE |
| :100CD00080932606609102016F3F89F0462F5527C9 |
| :100CE00034E0440F551F3A95E1F74C5F5E4F605D6D |
| :100CF00020E181E40E9436058FEF8093020180910C |
| :100D0000A303882359F180910101882339F10E94BE |
| :100D10006E101092A3033091AC03932F9F5F9093BA |
| :100D2000AC03943021F08091AD03882359F026E183 |
| :100D300040E357E060E084E30E9436058FEF809344 |
| :100D4000AC030CC044E1949FA0011124465E5C4FAB |
| :100D500024E160E0832F8F5C0E9436058091A5031B |
| :100D6000882371F080910101882351F02AE043E348 |
| :100D700056E06091F90486E50E9436051092A503BD |
| :100D800008951F93CF93DF93CDB7DEB722970FB6A9 |
| :100D9000F894DEBF0FBECDBF8091A703882309F46E |
| :100DA000DFC08FEF8093030180913F068B3609F4FB |
| :100DB0005EC08C3678F4833629F1843620F481368F |
| :100DC00009F0CCC013C0873609F45EC0883609F03C |
| :100DD000C5C02BC0813709F45BC0813708F480C0DF |
| :100DE0008437F1F1863709F0B9C04AC02091AA03CF |
| :100DF00043E062E0CE0101960E949E0589818093C6 |
| :100E00000201ACC02091AA0343E06BE088E296E0C7 |
| :100E10000E949E058091F10390912A06892B809370 |
| :100E2000F10381E08093A40399C02091AA0343E0D9 |
| :100E300062E0CE0101960E949E058091F1039981A6 |
| :100E4000892B8093F1038A818F3F21F481E0809385 |
| :100E5000AD0302C01092AD0381E08093A3037EC076 |
| :100E60002091AA0343E064E08EEA93E006C020915B |
| :100E7000AA0343E063E082EB93E00E949E056EC00C |
| :100E800081E08093A5036AC081E08093A20366C0DD |
| :100E90002091AA0343E062E0CE0101960E949E05E4 |
| :100EA00089818F3F89F0863010F085E0898347E49F |
| :100EB0006EE577E089810E94B202898127E44EE5E0 |
| :100EC00057E06091F90408C01091F9040E948B0268 |
| :100ED00027E44EE557E0612F855B0E9436053EC052 |
| :100EE0002091AA0343E067E48EE597E00E949E0507 |
| :100EF00080913F0647E46EE577E08B560E949A02A8 |
| :100F000080913F068B56A2E0B0E0082E0E94194760 |
| :100F10006091890777278827992724EC39E040E0FA |
| :100F200050E00E9482466093870370938803809309 |
| :100F3000890390938A0360918A07772788279927E6 |
| :100F40000E94824660938B0370938C0380938D0381 |
| :100F500090938E030E948B020E94D6201092A703CA |
| :100F600022960FB6F894DEBF0FBECDBFDF91CF91B2 |
| :100F70001F9108951F920F920FB60F9211242F9375 |
| :100F80003F934F935F936F937F938F939F93AF9311 |
| :100F9000BF93CF93DF93EF93FF938091C60080932D |
| :100FA000A6038091A6030E94203C4091B8034639D5 |
| :100FB00010F01092B7038091A6038D3009F05DC048 |
| :100FC0008091B703823009F058C01092B703A42F64 |
| :100FD000BB27FD01E55CF94F3081ED01C45CD94FC1 |
| :100FE00028818091BB039091BC03831B9109821BD4 |
| :100FF00091099F709093BC038093BB039C016894FC |
| :1010000015F8369527951694E1F7235C2093BA03DB |
| :10101000982F9F73935C9093B9038081281729F4CC |
| :101020008881981711F491E006C08091A9038F5F21 |
| :101030008093A90390E08091A703882309F064C0FE |
| :10104000992309F461C081E08093A7034093AA0328 |
| :10105000A35CB94F8DE08C9380913F06823509F0F7 |
| :1010600053C088E190E02CE00FB6F894A8958093E7 |
| :1010700060000FBE2093600047C08091B7038130AD |
| :10108000D9F0813018F08230E9F530C08091A603A4 |
| :10109000833239F48091A703882319F481E0809387 |
| :1010A000B7038091A60380933D0681E08093B80347 |
| :1010B0008091A603992715C082E08093B703E42F9F |
| :1010C000FF278091A603E35CF94F80834F5F409335 |
| :1010D000B8032091A6038091BB039091BC03820FBB |
| :1010E000911D9093BC038093BB030EC0E42FFF2798 |
| :1010F0008091A603E35CF94F8083463938F3109260 |
| :10110000B703E7CF1092B703FF91EF91DF91CF9133 |
| :10111000BF91AF919F918F917F916F915F914F910F |
| :101120003F912F910F900FBE0F901F901895982F01 |
| :1011300080911507813069F48091F003E82FFF2733 |
| :10114000E65EFC4F90838F5F8093F00321E030E0F8 |
| :1011500005C0892F0E94FB05282F3327C901089558 |
| :101160001F93182F04C080E30E9497081150111696 |
| :10117000D4F31F9108951F93182F04C080E20E949A |
| :10118000970811501116D4F31F9108950F931F93D0 |
| :10119000CF93DF938C01EB0108C0F8010F5F1F4F65 |
| :1011A000E4918E2F0E94970821972097B1F7DF9145 |
| :1011B000CF911F910F9108950F931F93CF93DF93BA |
| :1011C0008C01EB0106C0F80181918F010E94970804 |
| :1011D00021972097C1F7DF91CF911F910F9108952B |
| :1011E0002F923F924F925F926F927F928F929F9237 |
| :1011F000AF92BF92CF92DF92EF92FF920F931F9325 |
| :10120000CF93DF93CDB7DEB7E3970FB6F894DEBF89 |
| :101210000FBECDBF29968FAD299780931507CE01BC |
| :10122000855B9F4F9D838C832B968EAD9FAD2B97B7 |
| :101230009FA78EA722243324210102C01301240179 |
| :101240000EA51FA502C00F5F1F4FF801F490FF20ED |
| :1012500019F0F5E2FF16B9F7B8018EA59FA5681B36 |
| :10126000790B11F00E94C608FF2009F442C20F5FFB |
| :101270001F4F1FA70EA71982AC81BD811BAA1AAAF6 |
| :101280009FEF99ABEEA5FFA5CF0101969FA78EA773 |
| :10129000B49095E7B91621F08B2D8062883789F4D8 |
| :1012A000EBA9E0FF07C02D903D904D905C90139707 |
| :1012B000149607C08D919C9111971C0144245524CC |
| :1012C0001296F0E2BF1621F489818823D9F685C0F1 |
| :1012D00083E2B81609F483C09AE2B91621F0EDE270 |
| :1012E000BE1669F408C0FD011296E081EAABE7FF83 |
| :1012F000C9CFE195EAABFBA9F061FF7D72C08BE23B |
| :10130000B81609F46AC09EE2B916B1F52EA53FA53C |
| :101310002F5F3F4FEEA5FFA584918A3221F0B82EB2 |
| :1013200020E030E01BC0FD0112964081518157FF43 |
| :1013300002C04FEF5FEF49AB3FA72EA7A3CFC90174 |
| :1013400003E0880F991F0A95E1F7220F331F280F3A |
| :10135000391F2B0D311D20533040B49031968B2D09 |
| :1013600080538A3060F3FFA7EEA7A90137FF02C0C0 |
| :101370004FEF5FEF49AB8DCFF0E3BF1631F48BA990 |
| :1013800084FD80CF80628BAB7DCF8B2D81538930E4 |
| :10139000E8F420E030E0C901F3E0880F991FFA95E6 |
| :1013A000E1F7220F331F280F391F2B0D311D20535A |
| :1013B0003040EEA5FFA5CF0101969FA78EA7B49060 |
| :1013C0008B2D80538A3038F32AAB63CF98E6B91659 |
| :1013D00051F4EBA9E460EBAB55CFB98253CFFBA935 |
| :1013E000F860FBAB4FCF8CE6B81621F49BA9916057 |
| :1013F0009BAB48CFBD83AC83E3E6BE1639F41296AF |
| :10140000BD83AC8312978C918E8318C1F4E4BF1610 |
| :1014100039F084E6B81639F099E6B91659F503C0E3 |
| :10142000EBA9E160EBABFBA9F0FF08C01496BD830C |
| :10143000AC835E904E903E902E900AC01296BD8373 |
| :10144000AC839E918E911C01442437FC4094542C13 |
| :1014500057FC03C08AE088AB92C05094409430940B |
| :101460002094211C311C411C511C8DE289839AE07F |
| :1014700098AB85C0EFE4BE1629F0FFE6BF1639F43D |
| :1014800088E061C09BA991609BABE8E056C0F0E7A3 |
| :10149000BF1671F41296BD83AC839E918E911C0190 |
| :1014A000442455248BA980648BAB78E7B72E5EC0AB |
| :1014B000E3E7BE16D9F51296BD83AC83DE90CE90DD |
| :1014C000C114D10489F488E28E838EE68F8385E788 |
| :1014D00088878CE689878A8789E28B871C8666E005 |
| :1014E000C62ED12CCC0EDD1EF9A9F7FD13C04F2F4F |
| :1014F000552747FD509560E070E0C6010E940D45FC |
| :10150000009711F419A90DC08C1919A981174CF471 |
| :10151000182F07C0F60101900020E9F731971E2F20 |
| :101520001C1919824201310140E094C085E5B816CA |
| :1015300031F095E7B91649F4EAE0E8AB1FC0FBA922 |
| :10154000F160FBAB8AE088AB19C098E5B91621F0D1 |
| :10155000E8E7BE1609F06EC0FBA9F3FD02C080E10A |
| :10156000F2CF211431044104510419F490E198ABF5 |
| :1015700005C0EBA9E064EBABF0E1F8AB198289A9F7 |
| :1015800087FD03C09BA99F7D9BAB211431044104BF |
| :10159000510461F4E9A9EE2349F466247724430158 |
| :1015A0005EE2C52ED12CCC0EDD1E3EC04EE2C42E16 |
| :1015B000D12CCC0EDD1EF8A9EF2EFF240027112719 |
| :1015C000C201B101A80197010E94D4466A3020F4FB |
| :1015D00030E3A32EA60E08C027E5A22EA60E88E5AE |
| :1015E000B81611F49FEDA922F601A2926F01C20173 |
| :1015F000B101A80197010E94D44639014A012E1475 |
| :101600003F044006510618F019012A01D9CFF8A964 |
| :10161000F83051F48BA983FF07C090E3A91621F09D |
| :1016200080E3F60182936F01CE018C19182F125DB1 |
| :1016300049A910C0BB2009F45CC0BE8219824201D6 |
| :10164000310100E096E0C92ED12CCC0EDD1E11E058 |
| :1016500021E005C0212F042F011B07FD00E0898137 |
| :10166000882319F0812F8F5F07C09BA996FD02C0C8 |
| :10167000812F02C0822F8E5FA82EA00EEBA9EE2E26 |
| :10168000FF2480E3482E512C4E205F20411451044A |
| :1016900021F48AA98A190E94BB088981882329F02C |
| :1016A00061E070E0CE01019609C0E6FE09C080E36A |
| :1016B0008A83BB8262E070E0CE0102960E94DC0861 |
| :1016C000F0E24F16510421F48AA98A190E94B00849 |
| :1016D000802F0E94B008612F772767FD7095C601A3 |
| :1016E0000E94DC08E4FEAACD8AA98A190E94BB08E0 |
| :1016F000A5CDE3960FB6F894DEBF0FBECDBFDF9148 |
| :10170000CF911F910F91FF90EF90DF90CF90BF90FE |
| :10171000AF909F908F907F906F905F904F903F9091 |
| :101720002F9008951F920F920FB60F9211242F93AE |
| :101730003F935F936F937F938F939F93AF93BF93E9 |
| :101740008091CD0381508093CD038F3F11F580911F |
| :10175000CB039091CC03009729F001979093CC0391 |
| :101760008093CB0389E08093CD03809107038F5F43 |
| :10177000817080930703882319F481E08093C1036B |
| :101780008091BF039091C00301969093C003809312 |
| :10179000BF038091C4039091C5030297B8F0809174 |
| :1017A000C4039091C50301979093C5038093C4032C |
| :1017B0008091C4039091C5032091040330910503E7 |
| :1017C00082239323892B09F07BC006C08FEF9FEF04 |
| :1017D0009093050380930403809100018A3039F4CB |
| :1017E00004C05A9A05C0479A03C05A9801C0479846 |
| :1017F000349B0AC08091C2039091C30301969093D9 |
| :10180000C3038093C20362C08091C2039091C3035B |
| :10181000892BC1F18091C2039091C303805A9F40EC |
| :1018200088F58FEF90E09093CC038093CB03809169 |
| :10183000C2039091C3038758904090934B048093C8 |
| :101840004A0480914A0490914B0497FF0AC080910A |
| :101850004A0490914B0488599E4F90934B04809377 |
| :101860004A0480914A0490914B048856914054F068 |
| :1018700080914A0490914B048856914090934B0478 |
| :1018800080934A0480914A0490914B0420914C0427 |
| :1018900030914D04821B930B845E9D4F68E671E08E |
| :1018A0000E94C146845B904090934F0480934E0405 |
| :1018B00081E08093C8031092C3031092C20306C054 |
| :1018C000809100018A3009F08ECF8BCFBF91AF910C |
| :1018D0009F918F917F916F915F913F912F910F9089 |
| :1018E0000FBE0F901F9018952091BF033091C00339 |
| :1018F0002F5F3F4F820F931F08952091BF033091B8 |
| :10190000C003821B930B892F992786958074992792 |
| :1019100008951F920F920FB60F921124EF92FF922B |
| :101920000F931F932F933F934F935F936F937F93E7 |
| :101930008F939F93AF93BF93CF93DF93EF93FF93D7 |
| :10194000809106038150809306038F3F09F06DC09C |
| :1019500083E88093B00080919C03C82FDD27D0934B |
| :10196000C703C093C60380919307E090800780FF70 |
| :101970001EC060910E0470910F048091100490912C |
| :101980001104FF240027112720E830E040E050E058 |
| :101990000E94F646C801B7010E94824620E032E06C |
| :1019A00040E050E00E94F646C20FD31F1DC0609178 |
| :1019B0000E0470910F048091100490911104FF2483 |
| :1019C0000027112720E830E040E050E00E94F64672 |
| :1019D000C801B7010E94824620E032E040E050E0BA |
| :1019E0000E94F646C21BD30BD093C703C093C60315 |
| :1019F0002091C6033091C70380918107992728174A |
| :101A0000390734F08091820799278217930724F4CD |
| :101A10009093C7038093C6038091C6038093B3005D |
| :101A2000809183078093060304C083E08093B00015 |
| :101A30005F98FF91EF91DF91CF91BF91AF919F910F |
| :101A40008F917F916F915F914F913F912F911F9156 |
| :101A50000F91FF90EF900F900FBE0F901F90189571 |
| :101A60008091BF039091C0030B969093CF03809316 |
| :101A7000CE0382E085BD83EA84BD17BC88E788BDBC |
| :101A800096E096BD83EC8093B0009093B100E0E7C0 |
| :101A9000F0E0808182608083EEE6F0E0808181600A |
| :101AA00080838AE08093B3001092B2000895209161 |
| :101AB000BF033091C0032F5F3F4F280F391F4FEEF8 |
| :101AC00002C040937A008091BF039091C003B90196 |
| :101AD000681B790B77FFF5CF08952091BF033091F4 |
| :101AE000C0032F5F3F4F280F391F8091BF03909194 |
| :101AF000C003A901481B590B57FFF7CF0895109257 |
| :101B00007C008FEE80937A0008951F920F920FB69B |
| :101B10000F921124DF92EF92FF920F931F932F9356 |
| :101B20003F934F935F936F937F938F939F93AF9365 |
| :101B3000BF93CF93DF93EF93FF9310927A0080913E |
| :101B4000EC03D82ED394D092EC03853009F484C0F2 |
| :101B5000863090F4823009F440C0833030F488231A |
| :101B6000F1F0813009F04FC22FC0833009F43FC03B |
| :101B7000843009F048C258C0883009F4C0C08930A8 |
| :101B800038F4863009F481C0873009F03CC29AC02D |
| :101B9000893009F4D1C08A3009F035C2B1C18091D1 |
| :101BA0007800909179009093EB038093EA0381E0B1 |
| :101BB0008093ED038091E4039091E5030196909367 |
| :101BC000E5038093E40315C2809178009091790039 |
| :101BD0009093E9038093E80390C0809178009091FE |
| :101BE00079009093E7038093E60384E086C14091F7 |
| :101BF00008035091090380917800909179009A012F |
| :101C0000220F331F240F351F63E070E00E94AD46A2 |
| :101C1000260F371F3695279536952795309309035C |
| :101C20002093080386E069C180910604909107041F |
| :101C30002091780030917900821B930B90931707C5 |
| :101C40008093160780911607909117079093D703FA |
| :101C50008093D60387E051C18091780090917900FC |
| :101C60002091040430910504821B930B909322076A |
| :101C70008093210780912107909122079093D903A7 |
| :101C80008093D8031092ED03B4C18091000120919C |
| :101C9000EA033091EB038A3049F480917800909107 |
| :101CA0007900820F931F9695879506C080917800E2 |
| :101CB00090917900820F931F9093D5038093D40362 |
| :101CC00081E01BC1809100012091E8033091E9037C |
| :101CD0008A3049F48091780090917900820F931FA7 |
| :101CE0009695879506C08091780090917900820F33 |
| :101CF000931F9093D3038093D20382E0FEC0809120 |
| :101D000000012091E6033091E7038A3049F4809185 |
| :101D1000780090917900820F931F9695879506C061 |
| :101D20008091780090917900820F931F9093D10356 |
| :101D30008093D00385E0E1C06091780070917900D4 |
| :101D4000E0900804F090090400910A0410910B043B |
| :101D5000882777FD8095982F0E94C045A80197019C |
| :101D60000E941A450E94A3457093DB036093DA0337 |
| :101D70002091DA033091DB03E0911607F091170709 |
| :101D8000809121079091220797FF03C0909581953C |
| :101D90009F4F64E070E00E94C146EB01CF01F7FF66 |
| :101DA00003C0909581959F4F64E070E00E94C1460A |
| :101DB000260F371F2C0F3D1F3093DB032093DA03D0 |
| :101DC0008091DA039091DB03029704F1609108049B |
| :101DD0007091090480910A0490910B0420E030E096 |
| :101DE00048E454E40E94CA4588230CF03CC060914A |
| :101DF00008047091090480910A0490910B042AE070 |
| :101E000037ED43EA5CE30E941B4525C08091DA036D |
| :101E10009091DB038F5F9F4F34F5609108047091C0 |
| :101E2000090480910A0490910B0420E030E046E11F |
| :101E300054E40E94CD451816B4F4609108047091E2 |
| :101E4000090480910A0490910B042AE037ED43EADB |
| :101E50005CE30E941A456093080470930904809320 |
| :101E60000A0490930B0481E08093E1038091780051 |
| :101E70009091790090931907809318072091460458 |
| :101E80003091470440914804509149048091DA030D |
| :101E90009091DB03AA2797FDA095BA2F280F391F31 |
| :101EA0004A1F5B1F20934604309347044093480425 |
| :101EB00050934904E0904604F09047040091480490 |
| :101EC0001091490460914604709147048091480440 |
| :101ED0009091490420E034E040E050E00E94F64652 |
| :101EE000E21AF30A040B150BE0924604F092470441 |
| :101EF000009348041093490483E08093ED0379C074 |
| :101F000080912607909127072091780030917900E1 |
| :101F1000820F931F909327078093260780911E07B7 |
| :101F20008F5F80931E0780911E07853008F46BC079 |
| :101F3000809178009091790090930F0380930E0325 |
| :101F400010921E0780911A0790911B072091260777 |
| :101F500030912707821B930B209166043091670410 |
| :101F6000821B930B9093E3038093E2036091260717 |
| :101F700070912707E0900A03F0900B0300910C0387 |
| :101F800010910D03882777FD8095982FA801970160 |
| :101F9000220F331F441F551F2E0D3F1D401F511F81 |
| :101FA000620F731F841F951F24E030E040E050E073 |
| :101FB0000E94F64620930A0330930B0340930C03D0 |
| :101FC00050930D0320911A0730911B0780910A034B |
| :101FD00090910B03A0910C03B0910D03281B390BBA |
| :101FE0003093670420936604109227071092260707 |
| :101FF0000AC08091ED0380937C00DD2051F08FEECC |
| :1020000080937A0006C01092ED031092EC031092B8 |
| :102010007C00FF91EF91DF91CF91BF91AF919F91A4 |
| :102020008F917F916F915F914F913F912F911F9170 |
| :102030000F91FF90EF90DF900F900FBE0F901F90C9 |
| :102040001895CF93DF93A3E0B0E00E941147802D55 |
| :10205000C82FDD27C531D10508F02A97C7BD84E612 |
| :1020600090E00E94570D80910E0390910F038255CE |
| :102070009340D0F4C0E0D0E017C0C7BD82E390E049 |
| :102080000E94570D80E791E09F938F931F920E94CB |
| :10209000F00880910E0390910F030F900F900F9016 |
| :1020A0008458934020F02196CA3FD10530F3A3E035 |
| :1020B000B0E00C2E0E941947C09323078CE291E0F8 |
| :1020C0000E94570DDF91CF910895EAE1F3E080E29D |
| :1020D000819393E0EA36F907D9F70895FF920F93B9 |
| :1020E0001F938091F103282F3327C90181709070CD |
| :1020F000682F8823A9F08091F203882311F0815082 |
| :1021000002C080916A038093F203EAE1F3E080E287 |
| :10211000819393E0EA36F907D9F78FEF8093AC0308 |
| :10212000A9014270507021FF10C08091F2038F5FAF |
| :102130008093F203EAE1F3E080E2819393E0EA36F0 |
| :10214000F907D9F78FEF8093AC03662321F0452B75 |
| :1021500011F01092F20381E18093F0038091F20379 |
| :1021600099279F938F938CE194E09F938F9311E035 |
| :10217000F12EFF920E94F0080091F2030F900F9051 |
| :102180000F900F900F90053009F4FCC1063090F4C9 |
| :10219000023009F4CCC0033030F40023F1F00130F8 |
| :1021A00009F0D9C361C0033009F416C1043009F045 |
| :1021B000D2C365C1083009F416C3093038F40630BB |
| :1021C00009F499C2073009F0C6C3EAC2093009F41C |
| :1021D00047C30A3009F0BFC381C31092F0038AE0FD |
| :1021E00094E09F938F93FF920E94F00884E1809384 |
| :1021F000F0032091000181E690E09F938F9381E0AE |
| :1022000090E09F938F931F921F92822F6AE00E940B |
| :10221000A146892F99279F938F93822F0E94A146D1 |
| :1022200099279F938F9385EF93E09F938F93FF92CE |
| :102230000E94F00888E28093F0030E948B029927A5 |
| :102240009F938F9388EE93E09F938F93FF920E94CA |
| :10225000F0088CE38093F00388ED93E09F938F93D5 |
| :10226000FF920E94F00898C28091660780FF47C0E5 |
| :102270001092F00380916604909167049F938F936E |
| :1022800089EC93E09F938F930F930E94F00884E171 |
| :102290008093F00380916804909169049F938F93D9 |
| :1022A0008AEB93E09F938F930F930E94F00888E24C |
| :1022B0008093F00380910E0390910F039F938F936F |
| :1022C0008BEA93E09F938F930F930E94F0088CE327 |
| :1022D0008093F0038091230799279F938F938CE934 |
| :1022E00093E09F938F930F930E94F0088DB79EB752 |
| :1022F00044960FB6F8949EBF0FBE8DBF31C384E1E4 |
| :102300008093F00385E993E09F938F930F930E944E |
| :10231000F00888E28093F00387E893E09F938F931F |
| :102320000F930E94F0088DB79EB70696E2CF1092E9 |
| :10233000F0038DE793E09F938F93FF920E94F00844 |
| :1023400084E18093F00360910E0470910F048091FA |
| :1023500010049091110420E034E040E050E00E942D |
| :10236000F6465F934F933F932F938EE693E09F93B0 |
| :102370008F93FF920E94F00888E28093F0036091AF |
| :10238000160470911704809118049091190420E0AC |
| :1023900034E040E050E00E94F6465F934F933F9355 |
| :1023A0002F938FE593E09F938F93FF920E94F00805 |
| :1023B0008CE38093F00380914A0490914B049F93A7 |
| :1023C0008F9380E593E09F938F93FF920E94F00894 |
| :1023D0008DB79EB746968DCF1092F003809134074B |
| :1023E0009091350720913207309133079F938F9357 |
| :1023F0003F932F9380E493E09F938F93FF920E94EB |
| :10240000F00884E18093F0038091380790913907B8 |
| :1024100020913607309137079F938F933F932F93E7 |
| :1024200080E393E09F938F93FF920E94F00888E2ED |
| :102430008093F00380913C0790913D0720913A07EB |
| :1024400030913B079F938F933F932F9380E293E0CC |
| :102450009F938F93FF920E94F0088CE38093F00388 |
| :10246000809140079091410720913E0730913F07AE |
| :102470009F938F933F932F9380E193E07AC01092C4 |
| :10248000F003E0915F07FF27EE0FFF1FE05DF84FBD |
| :1024900020813181E0915E07FF27EE0FFF1FE05D95 |
| :1024A000F84F808191813F932F939F938F9380E08A |
| :1024B00093E09F938F93FF920E94F00884E18093B2 |
| :1024C000F003E0916107FF27EE0FFF1FE05DF84F7B |
| :1024D00020813181E0916007FF27EE0FFF1FE05D53 |
| :1024E000F84F808191813F932F939F938F9380EF3B |
| :1024F00092E09F938F93FF920E94F00888E280936E |
| :10250000F003E0916307FF27EE0FFF1FE05DF84F38 |
| :1025100020813181E0916207FF27EE0FFF1FE05D10 |
| :10252000F84F808191813F932F939F938F9380EEFB |
| :1025300092E09F938F93FF920E94F0088CE3809328 |
| :10254000F003E0916507FF27EE0FFF1FE05DF84FF6 |
| :1025500020813181E0916407FF27EE0FFF1FE05DCE |
| :10256000F84F808191813F932F939F938F9380EDBC |
| :1025700092E09F938F93FF920E94F0088DB79EB7D1 |
| :102580004C96B7CE1092F00382EC92E09F938F931B |
| :10259000FF920E94F0080F900F900F908091000121 |
| :1025A0008A3009F04AC084E18093F0034091FA0335 |
| :1025B0005091FB038091D0039091D1032091FA03B5 |
| :1025C0003091FB035F934F93821B930B9F938F93E9 |
| :1025D00083EB92E09F938F93FF920E94F00888E232 |
| :1025E0008093F0034091FC035091FD038091D2034E |
| :1025F0009091D3032091FC033091FD035F934F939F |
| :10260000821B930B9F938F9384EA92E09F938F9307 |
| :10261000FF920E94F0088CE38093F0038091FE0308 |
| :102620009091FF032091D7073091D8079F938F9304 |
| :102630003F932F9385E992E055C084E18093F003A6 |
| :102640008091FA039091FB032091D0033091D10344 |
| :10265000E091FA03F091FB0362E070E00E94C14652 |
| :102660007F936F932E1B3F0B3F932F9386E892E04F |
| :102670009F938F93FF920E94F00888E28093F0036B |
| :102680008091FC039091FD032091D2033091D303FC |
| :10269000E091FC03F091FD0362E070E00E94C1460E |
| :1026A0007F936F932E1B3F0B3F932F9387E792E00F |
| :1026B0009F938F93FF920E94F0088CE38093F00326 |
| :1026C0008091FE039091FF032091D7073091D807A6 |
| :1026D00062E070E00E94C1467F936F933F932F9317 |
| :1026E00088E692E09F938F93FF920E94F0088DB747 |
| :1026F0009EB74596FECD1092F0038BE592E09F9336 |
| :102700008F93FF920E94F00884E18093F003809100 |
| :102710000404909105042091D8033091D9039F932C |
| :102720008F933F932F938CE492E09F938F93FF922C |
| :102730000E94F00888E28093F00380910604909153 |
| :1027400007042091D6033091D7039F938F933F9333 |
| :102750002F938DE392E09F938F93FF920E94F00856 |
| :102760008CE38093F00360910804709109048091D8 |
| :102770000A0490910B040091B7071091B8070E94CA |
| :10278000A3457F936F931F930F938EE292E09F93E5 |
| :102790008F93FF920E94F0088DB79EB74896A9CDFF |
| :1027A00084E18093F00380910803909109039F9343 |
| :1027B0008F938FE192E09F938F93FF920E94F00896 |
| :1027C00088E28093F00380915E0499279F938F9312 |
| :1027D00080E192E09F938F93FF920E94F0088DB763 |
| :1027E0009EB70A9686CD1092F00381E092E09F9307 |
| :1027F0008F93FF920E94F00884E18093F003809110 |
| :102800004E0490914F049F938F9382EF91E09F939A |
| :102810008F93FF920E94F00888E28093F0038091EA |
| :102820004A0490914B049F938F9383EE91E09F9382 |
| :102830008F93FF920E94F0088CE38093F0038091C5 |
| :102840004C0490914D049F938F9384ED91E09F935E |
| :102850008F93FF920E94F0088DB79EB7429649CDA4 |
| :102860001092F00380915604909157049F938F9398 |
| :1028700088EC91E09F938F93FF920E94F00884E18F |
| :102880008093F00380915804909159049F938F9303 |
| :102890008CEB91E09F938F93FF920E94F00888E267 |
| :1028A0008093F00380915A0490915B049F938F93DF |
| :1028B00080EB91E09F938F93FF920E94F0088CE34E |
| :1028C0008093F00380915C0490915D049F938F93BB |
| :1028D00084EA91E09F938F93FF9206CD1092F003CC |
| :1028E0008CE991E09F938F93FF920E94F00884E11E |
| :1028F0008093F00380919C0399279F938F938EE898 |
| :1029000091E09F938F93FF920E94F00888E280935A |
| :10291000F0038091C6039091C7039F938F9380E843 |
| :1029200091E09F938F93FF920E94F0088CE3809335 |
| :10293000F0038091820799279F938F93809181075D |
| :1029400099279F938F9382E791E09F938F93FF92B4 |
| :102950000E94F008CBCC015000936A031092F2035E |
| :102960001092F1031F910F91FF9008951092B900FA |
| :102970008AE28093B800089585EA8093BC0080E0E5 |
| :1029800090E0089584E98093BC0008951092B90006 |
| :102990008093BB0085E88093BC0080E090E00895C0 |
| :1029A0001F920F920FB60F9211248F939F93EF9364 |
| :1029B000FF938091F3038F5F8093F3038150833003 |
| :1029C000A9F1843028F4813091F0823008F50AC0F2 |
| :1029D000853089F18530B8F18630A9F1873009F06A |
| :1029E00061C045C08091F403880F8E5A09C0809160 |
| :1029F000F4038F5F8093F403815027C08091A80770 |
| :102A00001092B9008093BB0085E88093BC004AC057 |
| :102A100084E98093BC008091F403843018F4109210 |
| :102A2000F30302C01092F40385EAEFCF8091F5031F |
| :102A3000880F8D5AE5CF8091BB00E091F503FF2709 |
| :102A4000E85DF84F80838091F503813039F0813063 |
| :102A5000A8F2823031F0833029F506C08091AD07AD |
| :102A6000CFCF8091CD07CCCF8091D107C9CF8091B6 |
| :102A7000F5039091BB00E82FFF27E85DF84F9483A2 |
| :102A80008F5F8093F503843010F01092F50384E992 |
| :102A90008093BC008AE090E0909386038093850346 |
| :102AA0001092F3038091BC0080688093BC00FF917A |
| :102AB000EF919F918F910F900FBE0F901F901895DF |
| :102AC0004CEB50E084E9DA018C931092F3032BEB8A |
| :102AD00030E0F90180811092F40380E88C93109229 |
| :102AE000BD001092BA001082E9EBF0E01082A8EB72 |
| :102AF000B0E01C9210828AE28C9385EADA018C9312 |
| :102B00001082F901108285E88C93089583EC8093FC |
| :102B10008100EFE6F0E08081806280831092FF0305 |
| :102B20001092FE031092FD031092FC031092FB031F |
| :102B30001092FA0308951F920F920FB60F9211246C |
| :102B40000F931F932F933F934F935F936F937F93B5 |
| :102B50008F939F93AF93BF93CF93DF93EF93FF93A5 |
| :102B600020918600309187008091F8039091F903BD |
| :102B7000281B390B80918600909187009093F90370 |
| :102B80008093F803C9018D549440C091F603D0910D |
| :102B9000F703835F9A4158F4249714F010926B0363 |
| :102BA00081E090E09093F7038093F60363C0CA300E |
| :102BB000D1050CF05FC0C9018B5F9040845B9140F0 |
| :102BC00008F040C0A901425D5140FE01EE0FFF1F19 |
| :102BD000E05DF84F80819181FA01E81BF90BCF018C |
| :102BE000F7FF03C0909581959F4F06974CF4809115 |
| :102BF0005E04883C28F480915E04865F80935E04C6 |
| :102C0000FE01EE0FFF1F8F01005D184FD8012D91BF |
| :102C10003C91C901880F991F820F931F840F951F44 |
| :102C200064E070E00E94C146D8018D919C9111979B |
| :102C30009B01281B390BEA5BF84F318320831196E7 |
| :102C40007C936E93FE013196F093F703E093F603C5 |
| :102C5000E530F10519F45D9A5C980BC05D98E6309B |
| :102C6000F10511F45C9A05C05C98379711F45B9AF2 |
| :102C700001C05B98FF91EF91DF91CF91BF91AF9130 |
| :102C80009F918F917F916F915F914F913F912F9184 |
| :102C90001F910F910F900FBE0F901F9018952F92BC |
| :102CA0003F924F925F926F927F928F929F92AF92DC |
| :102CB000BF92CF92DF92EF92FF920F931F93CF9329 |
| :102CC000DF93CDB7DEB722970FB6F894DEBF0FBE05 |
| :102CD000CDBF8091FE039091FF032091D4033091EA |
| :102CE000D503821B930B9093D8078093D7078091CD |
| :102CF000D2039091D3032091FC033091FD03821BFA |
| :102D0000930B9093A7078093A6078091D00390918F |
| :102D1000D1032091FA033091FB03821B930B909314 |
| :102D2000AF078093AE076091D4077091D5072091CB |
| :102D3000D8033091D903882777FD8095982F4427B1 |
| :102D400037FD4095542F04E0220F331F441F551FB9 |
| :102D50000A95D1F7620F731F841F951F22E030E0A0 |
| :102D600040E050E00E94F6463093D5072093D40708 |
| :102D70006091DE077091DF072091D6033091D70371 |
| :102D8000882777FD8095982F442737FD4095542F4D |
| :102D900014E0220F331F441F551F1A95D1F7620FFD |
| :102DA000731F841F951F22E030E040E050E00E9436 |
| :102DB000F6463093DF072093DE076091B7077091E6 |
| :102DC000B8072091DA033091DB03882777FD8095DF |
| :102DD000982F442737FD4095542F620F731F841F8F |
| :102DE000951F22E030E040E050E00E94F64630932C |
| :102DF000B8072093B70720911E0430911F0440911B |
| :102E00002004509121048091D8039091D903B4E01B |
| :102E1000880F991FBA95E1F7AA2797FDA095BA2FB9 |
| :102E2000280F391F4A1F5B1F20931E0430931F0475 |
| :102E300040932004509321042091220430912304D4 |
| :102E400040912404509125048091D6039091D7039A |
| :102E5000A4E0880F991FAA95E1F7AA2797FDA095EE |
| :102E6000BA2F280F391F4A1F5B1F2093220430936B |
| :102E70002304409324045093250460912604709108 |
| :102E800027048091280490912904E0901807F0907D |
| :102E90001907A0900804B0900904C0900A04D090CB |
| :102EA0000B040E94C0453B014C010027F7FC009534 |
| :102EB000102FC801B7010E94C045A60195010E94CC |
| :102EC0001A459B01AC01C401B3010E941B450E943D |
| :102ED000A34560932604709327048093280490935D |
| :102EE00029042091D7073091D807442737FD409512 |
| :102EF000542F8091E5079091E607A091E707B091E4 |
| :102F0000E807820F931FA41FB51F8093E5079093D6 |
| :102F1000E607A093E707B093E8072091D707309121 |
| :102F2000D807442737FD4095542F8091B9079091D9 |
| :102F3000BA07A091BB07B091BC07820F931FA41FD3 |
| :102F4000B51F8093B9079093BA07A093BB07B093BE |
| :102F5000BC0720913E0430913F04409140045091C1 |
| :102F600041048091D7079091D807AA2797FDA09593 |
| :102F7000BA2F280F391F4A1F5B1F20933E0430933E |
| :102F80003F04409340045093410420914204309107 |
| :102F9000430440914404509145048091D707909197 |
| :102FA000D807AA2797FDA095BA2F280F391F4A1FC7 |
| :102FB0005B1F209342043093430440934404509396 |
| :102FC000450420916E042A83222309F06BC080916E |
| :102FD0006F04882309F066C08091660786FF62C08F |
| :102FE00060912E0470912F048091300490913104EF |
| :102FF000E090D707F090D807A0907C04BB24CC24A5 |
| :10300000DD2420E030E140E050E00E94F646002759 |
| :10301000F7FC0095102FCA01B901A80197010E9481 |
| :103020008246A60195010E94824620E038E040E0F9 |
| :1030300050E00E94F6462093C7043093C8044093A2 |
| :10304000C9045093CA04609136047091370480918A |
| :10305000380490913904E090D707F090D80720E029 |
| :1030600030E140E050E00E94F6460027F7FC009572 |
| :10307000102FCA01B901A80197010E948246A6013A |
| :1030800095010E94824620E038E040E050E00E9436 |
| :10309000F6462093C3043093C4044093C504509370 |
| :1030A000C60410C01092C3041092C4041092C50448 |
| :1030B0001092C6041092C7041092C8041092C9045A |
| :1030C0001092CA048091A6079091A7072090C70488 |
| :1030D0003090C8044090C9045090CA04820D931DDA |
| :1030E0009093A7078093A6070091A6071091A707C2 |
| :1030F000A090C304B090C404C090C504D090C6048E |
| :1031000080917D04682E772488249924C601B50116 |
| :10311000A40193010E94824620E032E040E050E0AA |
| :103120000E94F646020F131F1093A7070093A607ED |
| :1031300020913A0430913B0440913C0450913D046D |
| :103140008091A6079091A707AA2797FDA095BA2F6F |
| :10315000280F391F4A1F5B1F20933A0430933B040A |
| :1031600040933C0450933D04209136043091370441 |
| :1031700040913804509139048091A6079091A70797 |
| :1031800060916A0470916B04861B970BAA2797FDC8 |
| :10319000A095BA2F280F391F4A1F5B1F20933604B2 |
| :1031A00030933704409338045093390480913604A7 |
| :1031B00090913704A0913804B0913904E0908B03CA |
| :1031C000F0908C0300918D0310918E03E816F906A0 |
| :1031D0000A071B0704F580E197E2A0E0B0E08E1932 |
| :1031E0009F09A00BB10B8093360490933704A093F2 |
| :1031F0003804B09339048091360490913704A0913B |
| :103200003804B091390480933A0490933B04A0931E |
| :103210003C04B0933D042091360430913704409132 |
| :1032200038045091390488279927DC018E199F09A9 |
| :10323000A00BB10B281739074A075B0704F580EF8D |
| :1032400098EDAFEFBFEFE80EF91E0A1F1B1FE092CB |
| :103250003604F092370400933804109339048091B7 |
| :10326000360490913704A0913804B09139048093CA |
| :103270003A0490933B04A0933C04B0933D048091A6 |
| :10328000D2039091D3030F9734F488E19CEF90938D |
| :10329000A7078093A6078091D2039091D303079745 |
| :1032A00034F480E398EF9093A7078093A60790915A |
| :1032B000000199839A30A9F48091D2039091D303AD |
| :1032C000835F934034F088EE93E09093A707809358 |
| :1032D000A6078091D2039091D3038A5F9340DCF0DC |
| :1032E00014C08091D2039091D303855E974034F04F |
| :1032F00088EE93E09093A7078093A6078091D2036E |
| :103300009091D303835F974034F080ED97E09093E2 |
| :10331000A7078093A6078091AE079091AF078A19FF |
| :103320009B099093AF078093AE070091AE07109171 |
| :10333000AF07C201B101A40193010E94824620E0BF |
| :1033400032E040E050E00E94F646021B130B10935F |
| :10335000AF070093AE0720913204309133044091BF |
| :103360003404509135048091AE079091AF07AA279D |
| :1033700097FDA095BA2F280F391F4A1F5B1F209376 |
| :103380003204309333044093340450933504209135 |
| :103390002E0430912F0440913004509131048091DB |
| :1033A000AE079091AF0760916C0470916D04861B1D |
| :1033B000970BAA2797FDA095BA2F280F391F4A1FF0 |
| :1033C0005B1F20932E0430932F04409330045093BE |
| :1033D000310480912E0490912F04A0913004B0917B |
| :1033E0003104E0908703F0908803009189031091E5 |
| :1033F0008A03E816F9060A071B0704F580E197E23D |
| :10340000A0E0B0E08E199F09A00BB10B80932E04B1 |
| :1034100090932F04A0933004B093310480912E0434 |
| :1034200090912F04A0913004B09131048093320424 |
| :1034300090933304A0933404B093350420912E0468 |
| :1034400030912F04409130045091310488279927FE |
| :10345000DC018E199F09A00BB10B281739074A0709 |
| :103460005B0704F580EF98EDAFEFBFEFE80EF91EB4 |
| :103470000A1F1B1FE0922E04F0922F0400933004C9 |
| :103480001093310480912E0490912F04A091300468 |
| :10349000B09131048093320490933304A0933404A8 |
| :1034A000B09335048091D0039091D1030F9734F4F9 |
| :1034B00088E19CEF9093AF078093AE078091D00393 |
| :1034C0009091D103079734F480E398EF9093AF077E |
| :1034D0008093AE0799819A30A9F48091D00390919E |
| :1034E000D103835F934034F088EE93E09093AF076D |
| :1034F0008093AE078091D0039091D1038A5F93406F |
| :10350000DCF014C08091D0039091D103855E974088 |
| :1035100034F088EE93E09093AF078093AE078091EC |
| :10352000D0039091D103835F974034F080ED97E012 |
| :103530009093AF078093AE078FEE80937A008091CF |
| :103540003E0490913F04A0914004B09141048093C7 |
| :103550002A0490932B04A0932C04B0932D04809103 |
| :103560002E0490912F04A0913004B09131048093E7 |
| :103570000E0490930F04A0931004B0931104809153 |
| :10358000360490913704A0913804B09139048093A7 |
| :10359000160490931704A0931804B0931904809113 |
| :1035A000320490913304A0913404B0913504809397 |
| :1035B000120490931304A0931404B0931504809103 |
| :1035C0003A0490913B04A0913C04B0913D04809357 |
| :1035D0001A0490931B04A0931C04B0931D048091C3 |
| :1035E000660787FF6BC02A81222309F067C080919C |
| :1035F0006F04882309F062C08091AE079091AF07F5 |
| :10360000893C91057CF02091AE073091AF07809105 |
| :10361000AE079091AF07880F991F880F991F20520E |
| :10362000334015C08091AE079091AF0788539F4FEC |
| :10363000A4F42091AE073091AF078091AE0790912E |
| :10364000AF07880F991F880F991F205E3C4F820F8C |
| :10365000931F9093AF078093AE078091A607909138 |
| :10366000A707893C91057CF02091A6073091A70718 |
| :103670008091A6079091A707880F991F880F991F1F |
| :103680002052334015C08091A6079091A707885318 |
| :103690009F4FA4F42091A6073091A7078091A60719 |
| :1036A0009091A707880F991F880F991F205E3C4FA4 |
| :1036B000820F931F9093A7078093A607209156042B |
| :1036C0003091570480916207E82FFF27EE0FFF1F0C |
| :1036D000E05DF84F8081918182599F4F281739070B |
| :1036E0001CF42F5F3F4F0CC08081918182599F4F06 |
| :1036F000821793074CF42115310531F021503040E9 |
| :103700003093570420935604209158043091590463 |
| :1037100080916307E82FFF27EE0FFF1FE05DF84F52 |
| :103720008081918182599F4F281739071CF42F5FA0 |
| :103730003F4F0CC08081918182599F4F8217930720 |
| :103740004CF42115310531F02150304030935904AB |
| :103750002093580420915A0430915B0480916407AF |
| :10376000E82FFF27EE0FFF1FE05DF84F808191816A |
| :1037700082599F4F281739071CF42F5F3F4F0CC009 |
| :103780008081918182599F4F821793074CF42115B4 |
| :10379000310531F02150304030935B0420935A04BE |
| :1037A00020915C0430915D0480916507E82FFF272C |
| :1037B000EE0FFF1FE05DF84F8081918182599F4F8E |
| :1037C000281739071CF42F5F3F4F0CC0808191816F |
| :1037D00082599F4F821793074CF42115310531F020 |
| :1037E0002150304030935D0420935C048091560456 |
| :1037F0009091570497FF05C01092570410925604F9 |
| :103800000AC08F3F910539F034F08FEF90E090932C |
| :10381000570480935604809158049091590497FF5F |
| :1038200005C010925904109258040AC08F3F9105A8 |
| :1038300039F034F08FEF90E090935904809358045E |
| :1038400080915A0490915B0497FF05C010925B042D |
| :1038500010925A040AC08F3F910539F034F08FEF6F |
| :1038600090E090935B0480935A0480915C04909163 |
| :103870005D0497FF05C010925D0410925C040AC0BD |
| :103880008F3F910539F034F08FEF90E090935D0415 |
| :1038900080935C0422960FB6F894DEBF0FBECDBFB6 |
| :1038A000DF91CF911F910F91FF90EF90DF90CF901C |
| :1038B000BF90AF909F908F907F906F905F904F9050 |
| :1038C0003F902F90089510927A008091D0039091AC |
| :1038D000D1039093AF078093AE078091D20390916C |
| :1038E000D3039093A7078093A6078091D403909168 |
| :1038F000D5039093D8078093D7078091D8039091F0 |
| :10390000D903AA2797FDA095BA2F74E0880F991FB5 |
| :10391000AA1FBB1F7A95D1F79093D5078093D40740 |
| :103920008091D6039091D703AA2797FDA095BA2F2F |
| :1039300064E0880F991FAA1FBB1F6A95D1F7909367 |
| :10394000DF078093DE078091DA039091DB03909389 |
| :10395000B8078093B7078FEE80937A0020915604C2 |
| :103960003091570480916207E82FFF27EE0FFF1F69 |
| :10397000E05DF84F8081918182599F4F2817390768 |
| :103980001CF42F5F3F4F0CC08081918182599F4F63 |
| :10399000821793074CF42115310531F02150304046 |
| :1039A00030935704209356042091580430915904C1 |
| :1039B00080916307E82FFF27EE0FFF1FE05DF84FB0 |
| :1039C0008081918182599F4F281739071CF42F5FFE |
| :1039D0003F4F0CC08081918182599F4F821793077E |
| :1039E0004CF42115310531F0215030403093590409 |
| :1039F0002093580420915A0430915B04809164070D |
| :103A0000E82FFF27EE0FFF1FE05DF84F80819181C7 |
| :103A100082599F4F281739071CF42F5F3F4F0CC066 |
| :103A20008081918182599F4F821793074CF4211511 |
| :103A3000310531F02150304030935B0420935A041B |
| :103A400020915C0430915D0480916507E82FFF2789 |
| :103A5000EE0FFF1FE05DF84F8081918182599F4FEB |
| :103A6000281739071CF42F5F3F4F0CC080819181CC |
| :103A700082599F4F821793074CF42115310531F07D |
| :103A80002150304030935D0420935C0480915604B3 |
| :103A90009091570497FF05C0109257041092560456 |
| :103AA0000AC08F3F910539F034F08FEF90E090938A |
| :103AB000570480935604809158049091590497FFBD |
| :103AC00005C010925904109258040AC08F3F910506 |
| :103AD00039F034F08FEF90E09093590480935804BC |
| :103AE00080915A0490915B0497FF05C010925B048B |
| :103AF00010925A040AC08F3F910539F034F08FEFCD |
| :103B000090E090935B0480935A0480915C049091C0 |
| :103B10005D0497FF05C010925D0410925C040AC01A |
| :103B20008F3F910539F034F08FEF90E090935D0472 |
| :103B300080935C046091890777278827992724EC74 |
| :103B400039E040E050E00E94824660938703709322 |
| :103B500088038093890390938A0360938B03709307 |
| :103B60008C0380938D0390938E0308951F9380910F |
| :103B700069078B3F98F08B3F19F4809156040EC073 |
| :103B80008C3F19F48091580409C08D3F19F480913D |
| :103B90005A0404C08E3F21F480915C048093940306 |
| :103BA00080919403882319F41092940304C08F3FEA |
| :103BB00011F480939403809168078B3F98F08B3FBA |
| :103BC00019F4809156040EC08C3F19F4809158046A |
| :103BD00009C08D3F19F480915A0404C08E3F21F42E |
| :103BE00080915C048093930380919303882319F45C |
| :103BF0001092930305C0843618F084E680939303F3 |
| :103C000080916A078B3F98F08B3F19F4809156049E |
| :103C10000EC08C3F19F48091580409C08D3F19F4EF |
| :103C200080915A0404C08E3F21F480915C048093FB |
| :103C3000950380919503882319F41092950305C08C |
| :103C4000843618F084E68093950380916C078B3F4F |
| :103C500098F08B3F19F4809156040EC08C3F19F4F4 |
| :103C60008091580409C08D3F19F480915A0404C012 |
| :103C70008E3F21F480915C0480939603809196039B |
| :103C8000882319F41092960304C08F3F11F4809397 |
| :103C90009603809173078B3F98F08B3F19F48091C6 |
| :103CA00056040EC08C3F19F48091580409C08D3F12 |
| :103CB00019F480915A0404C08E3F21F480915C0471 |
| :103CC0008093970380919703882319F410929703A8 |
| :103CD00004C08F3F11F480939703809174078B3F4A |
| :103CE00098F08B3F19F4809156040EC08C3F19F464 |
| :103CF0008091580409C08D3F19F480915A0404C082 |
| :103D00008E3F21F480915C04809398038091980306 |
| :103D10008B3010F48AE002C08F3F11F48093980337 |
| :103D2000809175078B3F98F08B3F19F48091560472 |
| :103D30000EC08C3F19F48091580409C08D3F19F4CE |
| :103D400080915A0404C08E3F21F480915C048093DA |
| :103D5000990380919903882319F41092990304C060 |
| :103D60008F3F11F48093990380917A078B3F98F0ED |
| :103D70008B3F19F4809156040EC08C3F19F480914A |
| :103D8000580409C08D3F19F480915A0404C08E3F35 |
| :103D900021F480915C0480939B0380919B03882392 |
| :103DA00019F410929B0304C08F3F11F480939B037E |
| :103DB00080917B078B3F98F08B3F19F480915604DC |
| :103DC0000EC08C3F19F48091580409C08D3F19F43E |
| :103DD00080915A0404C08E3F21F480915C0480934A |
| :103DE000740480917404882319F41092740404C03C |
| :103DF0008F3F11F48093740480917C078B3F98F07F |
| :103E00008B3F19F4809156040EC08C3F19F48091B9 |
| :103E1000580409C08D3F19F480915A0404C08E3FA4 |
| :103E200021F480915C04809375048091750488234B |
| :103E300019F41092750404C08F3F11F48093750437 |
| :103E400080917D078B3F98F08B3F19F48091560449 |
| :103E50000EC08C3F19F48091580409C08D3F19F4AD |
| :103E600080915A0404C08E3F21F480915C048093B9 |
| :103E7000760480917604882319F41092760404C0A5 |
| :103E80008F3F11F48093760480917E078B3F98F0EA |
| :103E90008B3F19F4809156040EC08C3F19F4809129 |
| :103EA000580409C08D3F19F480915A0404C08E3F14 |
| :103EB00021F480915C0480937704809177048823B7 |
| :103EC00019F41092770404C08F3F11F480937704A3 |
| :103ED00080918E078B3F98F08B3F19F480915604A8 |
| :103EE0000EC08C3F19F48091580409C08D3F19F41D |
| :103EF00080915A0404C08E3F21F480915C04809329 |
| :103F0000780480917804882319F41092780404C00E |
| :103F10008F3F11F48093780480918F078B3F98F046 |
| :103F20008B3F19F4809156040EC08C3F19F4809198 |
| :103F3000580409C08D3F19F480915A0404C08E3F83 |
| :103F400021F480915C048093790480917904882322 |
| :103F500019F41092790404C08F3F11F4809379040E |
| :103F6000809190078B3F98F08B3F19F48091560415 |
| :103F70000EC08C3F19F48091580409C08D3F19F48C |
| :103F800080915A0404C08E3F21F480915C04809398 |
| :103F90007A0480917A04882319F410927A0404C078 |
| :103FA0008F3F11F480937A04809191078B3F98F0B2 |
| :103FB0008B3F19F4809156040EC08C3F19F4809108 |
| :103FC000580409C08D3F19F480915A0404C08E3FF3 |
| :103FD00021F480915C0480937B0480917B0488238E |
| :103FE00019F410927B0404C08F3F11F480937B047A |
| :103FF00080917F078B3F98F08B3F19F48091560496 |
| :104000000EC08C3F19F48091580409C08D3F19F4FB |
| :1040100080915A0404C08E3F21F480915C04809307 |
| :104020009C0380919C03882319F410929C0304C084 |
| :104030008F3F11F480939C03809184078B3F98F00D |
| :104040008B3F19F4809156040EC08C3F19F4809177 |
| :10405000580409C08D3F19F480915A0404C08E3F62 |
| :1040600021F480915C0480939D0380919D038823BB |
| :1040700019F410929D0304C08F3F11F480939D03A7 |
| :10408000809187078B3F98F08B3F19F480915604FD |
| :104090000EC08C3F19F48091580409C08D3F19F46B |
| :1040A00080915A0404C08E3F21F480915C04809377 |
| :1040B0007C0480917C04882319F410927C0404C051 |
| :1040C0008F3F11F480937C04809188078B3F98F098 |
| :1040D0008B3F19F4809156040EC08C3F19F48091E7 |
| :1040E000580409C08D3F19F480915A0404C08E3FD2 |
| :1040F00021F480915C0480937D0480917D04882369 |
| :1041000019F410927D0404C08F3F11F480937D0454 |
| :1041100080918D078B3F98F08B3F19F48091560466 |
| :104120000EC08C3F19F48091580409C08D3F19F4DA |
| :1041300080915A0404C08E3F21F480915C048093E6 |
| :104140009E0380919E03882319F410929E0304C05D |
| :104150008F3F11F480939E0310919B03612F77276B |
| :1041600067FD7095872F972F0E94C04517FF06C0E7 |
| :1041700020E030E040E853E40E941B4527E137EBA4 |
| :1041800041ED58E30E943A4660938F037093900389 |
| :104190008093910390939203809171078093D60747 |
| :1041A000809170078093B0071F9108951F93182F77 |
| :1041B0000EC080916504882361F484E690E09093BA |
| :1041C000C5038093C4038AEF90E00E946D0D1150E7 |
| :1041D00080F71F91089580916504882301F510925E |
| :1041E000AD071092A8071092CD071092D1078091C9 |
| :1041F000AE03882311F08093A8078091AF03882332 |
| :1042000011F08093AD078091B003882311F0809363 |
| :10421000D1078091B103882311F08093CD0780915D |
| :10422000A80799279093EE068093ED068091AD073D |
| :1042300099279093F0068093EF068091D1079927F4 |
| :104240009093F2068093F1068091CD079927909381 |
| :10425000F4068093F3061092F3031092F4030E9485 |
| :10426000BC140895469A109205041092040410920A |
| :1042700007041092060480E090E0A0E0B0E0809394 |
| :10428000080490930904A0930A04B0930B041092BD |
| :10429000FB031092FA031092FD031092FC0310929C |
| :1042A000FF031092FE0310927C0410927D040E9482 |
| :1042B000631C84E690E00E94570D0E94631C80916D |
| :1042C000660780FF10C080910E0390910F03875BFB |
| :1042D000934038F480910E0390910F038E5E9240CC |
| :1042E00010F40E9421108091D0039091D1039093FB |
| :1042F000FB038093FA038091D2039091D3039093B0 |
| :10430000FD038093FC038091D4039091D503909397 |
| :10431000FF038093FE038091FC039091FD03909333 |
| :104320000104809300048091FA039091FB03909321 |
| :1043300003048093020444E050E0DA010E94114734 |
| :10434000802D853038F18091DE079091DF0797FF4F |
| :1043500003C0909581959F4F60E170E00E94C14637 |
| :1043600070930704609306048091D4079091D50759 |
| :1043700097FF03C0909581959F4F60E170E00E9488 |
| :10438000C14670930504609304046091180770910E |
| :10439000190739C0DA010E941147802D4F5F5F4F26 |
| :1043A000DA010E941147202D9927982F8827820F24 |
| :1043B000911D90930504809304044F5F5F4FDA01D1 |
| :1043C0000E941147802D4F5F5F4FDA010E94114715 |
| :1043D000202D9927982F8827820F911D90930704ED |
| :1043E000809306044F5F5F4FDA010E941147602DF2 |
| :1043F0004F5F5F4FDA010E941147202D7727762FFC |
| :104400006627620F711D882777FD8095982F0E947F |
| :10441000C045609308047093090480930A04909344 |
| :104420000B0410922E0410922F041092300410925C |
| :10443000310410923204109233041092340410921A |
| :1044400035041092360410923704109238041092FA |
| :10445000390410923A0410923B0410923C041092DA |
| :104460003D0410923E0410923F04109240041092BA |
| :1044700041041092AF071092AE071092A707109256 |
| :10448000A6071092D8071092D7071092B90710927A |
| :10449000BA071092BB071092BC0780910A03909153 |
| :1044A0000B03A0910C03B0910D0390931B07809315 |
| :1044B0001A071092E3031092E2031092460410923E |
| :1044C0004704109248041092490480914A04909144 |
| :1044D0004B0490934D0480934C040E94EB3A82E38A |
| :1044E00090E09093C5038093C40360918907772778 |
| :1044F0008827992724EC39E040E050E00E9482466A |
| :1045000060938703709388038093890390938A0351 |
| :1045100060918A077727882799270E9482466093AF |
| :104520008B0370938C0380938D0390938E03109272 |
| :10453000A00310929F0320914A0430914B0484E120 |
| :1045400095E0AC01249FC001259F900D349F900DF4 |
| :104550001124AA2797FDA095BA2F8093E507909381 |
| :10456000E607A093E707B093E8078EE190E0909309 |
| :10457000CE048093CD049093CC048093CB04089513 |
| :1045800081E080935E0752E050935F0743E04093E1 |
| :10459000600774E07093610765E06093620786E0EE |
| :1045A0008093630787E08093640798E090936507A2 |
| :1045B00080EC809366078EE1809367078BEF809392 |
| :1045C00069073AE030936A0722E320936807209353 |
| :1045D0006C0750936B0740936D0710926E07909392 |
| :1045E0006F078FE0809370078AEF809371078AE1ED |
| :1045F0008093720780E88093730788EC8093740738 |
| :104600008FEA8093750794E6909376078FE5809301 |
| :1046100077078CE3809378071092790730937A07B5 |
| :1046200080E580937B0710927C0710927D071092A3 |
| :104630007E0710928E0710928F07109290071092AB |
| :10464000910790937F0788E28093800710929307E9 |
| :104650002093810786E980938207609383072093E4 |
| :1046600084078AE580938507209386071092920736 |
| :1046700090938707309388079093890790938A07D0 |
| :1046800090938B0770938C0720938D07A8E9B7E070 |
| :10469000ECE6F3E08CE001900D928150E1F7089593 |
| :1046A00081E080935E0792E090935F0783E08093C0 |
| :1046B000600744E04093610755E05093620786E04D |
| :1046C0008093630787E08093640788E080936507A1 |
| :1046D00080E4809366078EE1809367078BEF809379 |
| :1046E00069073AE030936A0722E320936807209332 |
| :1046F0006C0790936B0740936D0710926E07309391 |
| :104700006F078FE0809370078AEF809371078AE1CB |
| :104710008093720780E8809373078FEA8093740711 |
| :104720008093750794E6909376078FE580937707DB |
| :104730008CE3809378071092790780E280937A0760 |
| :1047400080E580937B0710927C0710927D07109282 |
| :104750007E0710928E0710928F071092900710928A |
| :10476000910790937F0788E28093800710929307C8 |
| :104770002093810786E980938207509383072093D3 |
| :1047800084078AE580938507209386071092920715 |
| :1047900090938707309388079093890790938A07AF |
| :1047A00090938B0740938C078BE480938D07A8E947 |
| :1047B000B7E0E6E7F3E08CE001900D928150E1F77D |
| :1047C000089581E080935E0782E080935F0783E035 |
| :1047D0008093600734E03093610765E0609362077F |
| :1047E00086E08093630787E08093640788E0809386 |
| :1047F000650780E4809366078EE1809367078BEFFF |
| :10480000809369075AE050936A0722E32093680770 |
| :1048100020936C0730936B0730936D0730936E07CE |
| :104820008EE080936F078FE0809370078AEF80930C |
| :1048300071078AE18093720780E88093730788E7A5 |
| :104840008093740746E94093750794E69093760742 |
| :104850008FE5809377078CE3809378071092790730 |
| :1048600080E280937A0710927B0710927C07109267 |
| :104870007D0710927E0710928E0710928F0710927C |
| :1048800090071092910790937F0788E280938007AA |
| :1048900010929307209381074093820760938307C8 |
| :1048A000209384078AE580938507209386071092DA |
| :1048B0009207909387075093880790938907909366 |
| :1048C0008A0720938B0730938C0790938D07A8E974 |
| :1048D000B7E0EEE7F3E08CE001900D928150E1F754 |
| :1048E00008952F923F924F925F926F927F928F9294 |
| :1048F0009F92AF92BF92CF92DF92EF92FF920F936F |
| :104900001F93CF93DF93CDB7DEB76A970FB6F894B6 |
| :10491000DEBF0FBECDBF0E944F1680915C08909104 |
| :104920005D08009729F0019790935D0880935C08DB |
| :104930000E94953B892B39F4809100018A3011F453 |
| :10494000289A01C02898299AE0916007FF27EE0F66 |
| :10495000FF1FE05DF84F0190F081E02DE858FF4F18 |
| :104960008091D607082F112704511040E017F10756 |
| :104970000CF48F0120910803309109038091760790 |
| :1049800099270297409184045091850482179307D8 |
| :10499000ACF122E04D3B520714F1109285041092C5 |
| :1049A0008404E091CB04F091CC042091CD043091AB |
| :1049B000CE04C901880F991F820F931F880F991F7A |
| :1049C000880F991F6FE070E00E94C1466E177F0745 |
| :1049D00064F43197F093CC04E093CB0406C04F5FAE |
| :1049E0005F4F50938504409384048091CB04909151 |
| :1049F000CC0480179107F4F1C8013CC033E0493E74 |
| :104A00005307BCF02091CD043091CE04C90143E09E |
| :104A1000880F991F4A95E1F7820F931F800F911F0E |
| :104A20006AE070E00E94C1467093CE046093CD04AA |
| :104A300019C0CA01019690938504809384046AE0AA |
| :104A400070E00E94C146892B89F48091CB0490913B |
| :104A5000CC048017910734F401969093CC04809392 |
| :104A6000CB0404C01093CC040093CB048091CB04FE |
| :104A70009091CC049A83898397FF02C01A8219828D |
| :104A800080915E04843608F05DC080910301882324 |
| :104A900099F480910403909105038F5F9F4F61F417 |
| :104AA00088E99AE39093C5038093C40380E09CE077 |
| :104AB00090930503809304038091A5049091A6042C |
| :104AC000009731F001979093A6048093A50404C049 |
| :104AD0001092650410925004809100018A3011F404 |
| :104AE000289A01C028988091A0049091A104815D2A |
| :104AF000974028F180917707682F77277A83698319 |
| :104B000081E080935004E0915E07FF27EE0FFF1FC6 |
| :104B1000E05DF84F11821082E0915F07FF27EE0FF2 |
| :104B2000FF1FE05DF84F11821082E0916107FF27BF |
| :104B3000EE0FFF1FE05DF84F118210826EC21092DF |
| :104B400065046BC280915E048D3808F466C21092D1 |
| :104B500050048091780722E3829FC0011124909332 |
| :104B6000A6048093A50489819A8189976CF080912D |
| :104B7000A0049091A104AFEF8F3F9A0781F10196B5 |
| :104B80009093A1048093A0048091A0049091A1042B |
| :104B9000883C910520F0E981FA81B89704F51092DC |
| :104BA000BF041092C0041092C1041092C20410926B |
| :104BB000BB041092BC041092BD041092BE0410926B |
| :104BC0003E0410923F04109240041092410410924F |
| :104BD0004204109243041092440410924504298127 |
| :104BE0003A81293C31050CF472C180916504882317 |
| :104BF00009F013C280916107E82FFF27EE0FFF1F16 |
| :104C0000E05DF84F808191818C3491050CF4D5C022 |
| :104C10008091A4048F5F8093A404893C08F4FDC1B3 |
| :104C200029980E943221109265041092A4041092D7 |
| :104C3000A1041092A00480915E07282F3327F90168 |
| :104C4000EE0FFF1FE05DF84F808191818734910561 |
| :104C50009CF4E0915F07FF27EE0FFF1FE05DF84F28 |
| :104C60000190F081E02DF7FF03C0F095E195FF4F33 |
| :104C7000E734F1050CF46CC080915F07682F77274B |
| :104C8000DB01AA0FBB1FA05DB84F8D919C911197BE |
| :104C9000873491053CF0F901EE0FFF1FE05DF84FFE |
| :104CA000808191818D919C918734910564F0F90107 |
| :104CB000EE0FFF1FE05DF84F8081918187349105F1 |
| :104CC00014F042E001C041E0FB01EE0FFF1FE05D88 |
| :104CD000F84F80819181863491055CF4F901EE0FE3 |
| :104CE000FF1FE05DF84F80819181873491050CF0C2 |
| :104CF00043E0FB01EE0FFF1FE05DF84F80819181E3 |
| :104D00008A5B9F4F5CF4F901EE0FFF1FE05DF84FE7 |
| :104D100080819181873491050CF044E0660F771F04 |
| :104D2000605D784FDB018D919C918A5B9F4F5CF4B5 |
| :104D3000220F331F205D384FF90180819181863425 |
| :104D400091050CF445E0A2E0B0E0042E0E94194762 |
| :104D50000E948B0247E46EE577E00E94B2020E9457 |
| :104D60008B020E94D6208091660780FF10C0809140 |
| :104D70000E0390910F03875B934038F480910E03EC |
| :104D800090910F038E5E924010F40E9421100E94B9 |
| :104D9000E83B80913E08882309F43FC188EE93E008 |
| :104DA0000E946D0D80ED97E09093C5038093C4033E |
| :104DB00084EF91E00E946D0D30C180819181855B0F |
| :104DC0009F4F0CF081C08091A4048F5F8093A40456 |
| :104DD000893C08F422C129988FEF04E010E0D80143 |
| :104DE000082E0E941947109265041092A404109294 |
| :104DF000A1041092A0040E94322180910404909199 |
| :104E0000050460E071E00E94C146D801062E0E94B0 |
| :104E10001947809104049091050460E071E00E94BC |
| :104E2000C1460F5F1F4FD801082E0E94194780917D |
| :104E300006049091070460E071E00E94C1460F5F94 |
| :104E40001F4FD801062E0E941947809106049091A9 |
| :104E5000070460E071E00E94C1460F5F1F4FD80158 |
| :104E6000082E0E94194760910804709109048091EE |
| :104E70000A0490910B040E94A345DC01CB0160E081 |
| :104E800071E00E94C1460F5F1F4FD801062E0E949D |
| :104E90001947609108047091090480910A04909167 |
| :104EA0000B040E94A345DC01CB0160E071E00E948D |
| :104EB000C1460F5F1F4FD801082E0E9419470E945C |
| :104EC0008B020E94D620A9C01092A404A6C0E9813A |
| :104ED000FA81B3970CF0A1C0E0916107FF27EE0FB4 |
| :104EE000FF1FE05DF84F80819181855B9F4F0CF043 |
| :104EF00072C08091A3048F5F8093A304893C08F45F |
| :104F00006CC0469A88EC8093A30481E090E0909373 |
| :104F1000A1048093A00481E0809365041092B704FB |
| :104F20001092B8041092B9041092BA0410923E0480 |
| :104F300010923F04109240041092410410924204D7 |
| :104F400010924304109244041092450410922E04CF |
| :104F500010922F04109230041092310410923604F3 |
| :104F600010923704109238041092390480910E0484 |
| :104F700090910F04A0911004B09111048093320419 |
| :104F800090933304A0933404B093350480911604B5 |
| :104F900090911704A0911804B091190480933A04D9 |
| :104FA00090933B04A0933C04B0933D041092BF0443 |
| :104FB0001092C0041092C1041092C2041092BB045B |
| :104FC0001092BC041092BD041092BE0480E090E0E8 |
| :104FD0000E943D3D02C01092A304E0916107FF27AB |
| :104FE000EE0FFF1FE05DF84F808191818C349105B9 |
| :104FF00094F08091A2048F5F8093A204893C68F0B2 |
| :1050000046981092650488EC8093A2041092A10443 |
| :105010001092A00402C01092A20480916B038150F0 |
| :1050200080936B0380916B038F3F29F08091500434 |
| :10503000882309F442C30E94B61D80915E07682E42 |
| :105040007724D301AA0FBB1FFD01E05DF84F01904B |
| :10505000F081E02DF88FEF8B80916D07E82EFF2413 |
| :10506000AA5BB84F0D90BC91A02DBE8BAD8B8091EB |
| :105070006E07C82EDD2480915F07882E9924C40115 |
| :10508000880F991FDC01A05DB84F0D90BC91A02D39 |
| :10509000BC8BAB8B8A5B984FDC01AD90BC90E091F0 |
| :1050A0006107AE2FBB27AA0FBB1FA05DB84F0D90A5 |
| :1050B000BC91A02DBA8BA98B10919803612F7727F3 |
| :1050C00067FD7095872F972F0E94C04517FF06C078 |
| :1050D00020E030E040E853E40E941B4520E030E04F |
| :1050E00040E251E40E941B4520E030E040E85BE3F1 |
| :1050F0000E943A461B012C016093D9077093DA078E |
| :105100008093DB079093DC0710919903612F772739 |
| :1051100067FD7095872F972F0E94C04517FF06C027 |
| :1051200020E030E040E853E40E941B4520E030EEF0 |
| :105130004BE257E40E945D456093C9077093CA072C |
| :105140008093CB079093CC072091B303222311F4D3 |
| :105150000C94F9398AE090E09093C5038093C403DE |
| :10516000E22FFF27E2FF09C080917404482F5527E2 |
| :10517000440F551F440F551F10C0E3FD03C040E00E |
| :1051800050E00BC0809174049927880F991F880FF5 |
| :10519000991F44275527481B590B20917E043091B5 |
| :1051A0007F04C901F3E0880F991FFA95E1F7821B8C |
| :1051B000930B840F951F68E070E00E94C1468B013D |
| :1051C00070937F0460937E04E4FF09C080917404AF |
| :1051D000482F5527440F551F440F551F0FC0E5FD9D |
| :1051E00002C00C940E3A809174049927880F991F7D |
| :1051F000880F991F44275527481B590B209180047D |
| :1052000030918104C90163E0880F991F6A95E1F725 |
| :10521000821B930B840F951F68E070E00E94C146CB |
| :105220007A8F698F70938104609380048091B203B8 |
| :10523000282F332723FF03C082E390E004C022FF1E |
| :1052400007C08EEC9FEF909383048093820404C088 |
| :10525000109283041092820421FF09C080919F0361 |
| :105260009091A00301969093A00380939F0324FF45 |
| :1052700009C080919F039091A00301979093A00390 |
| :1052800080939F032F89388D2E9DF0012F9DF00D67 |
| :105290003E9DF00D11244D895E894C9DC0014D9DB0 |
| :1052A000900D5C9D900D1124E80FF91FC80168E076 |
| :1052B00070E00E94C146E60FF71FF88FEF8BF09366 |
| :1052C0006004E0935F046B897C896E9D80016F9D13 |
| :1052D000100D7E9D100D1124AC9CC001AD9C900D55 |
| :1052E000BC9C900D1124080F191F898D9A8D68E0C0 |
| :1052F00070E00E94C146060F171F109362040093CE |
| :1053000061048091820490918304A989BA898A1BDF |
| :105310009B0B90936404809363048091660782FFE3 |
| :105320000CC080E090E0A0E0B0E08093C9079093CB |
| :10533000CA07A093CB07B093CC0720E030E040E051 |
| :1053400050E0C201B1010E94CA45882364F480E0A4 |
| :1053500090E0A0E0B0E08093D9079093DA07A093A3 |
| :10536000DB07B093DC0720E030E040E050E06091E4 |
| :10537000C9077091CA078091CB079091CC070E9412 |
| :10538000CA45882364F480E090E0A0E0B0E0809318 |
| :10539000C9079093CA07A093CB07B093CC0780911D |
| :1053A0009207682F772734E0432E512C462257224C |
| :1053B00062FDC5C063FDC3C080910E0490910F04CF |
| :1053C000A0911004B091110481569A4EA040B040B3 |
| :1053D0004CF1C70123E0880F991F2A95E1F7EF8967 |
| :1053E000F88DE81BF90BF0936004E0935F04809163 |
| :1053F0000E0490910F04A0911004B09111048158F3 |
| :105400009843A140B0400CF441C0C701B4E0880FFC |
| :10541000991FBA95E1F7E81BF90BF0936004E0934C |
| :105420005F0434C080910E0490910F04A091100489 |
| :10543000B0911104805A9541AF4FBF4F3CF5970191 |
| :10544000A3E0220F331FAA95E1F74F89588D240F4F |
| :10545000351F3093600420935F0480910E04909177 |
| :105460000F04A0911004B091110481589843A140F9 |
| :10547000B04064F0C701F4E0880F991FFA95E1F796 |
| :10548000281B390B3093600420935F04809116042D |
| :1054900090911704A0911804B091190481569A4E66 |
| :1054A000A040B040DCF0C701E3E0880F991FEA9507 |
| :1054B000E1F79801281B390B3093620420936104B3 |
| :1054C0008091160490911704A0911804B0911904CA |
| :1054D00081589843A140B04094F126C080911604B1 |
| :1054E00090911704A0911804B0911904805A954125 |
| :1054F000AF4FBF4F24F5970173E0220F331F7A950A |
| :10550000E1F7200F311F30936204209361048091F2 |
| :10551000160490911704A0911804B09119048158B1 |
| :105520009843A140B0405CF054E0EE0CFF1C5A954B |
| :10553000E1F72E193F093093620420936104F401CE |
| :10554000EE0FFF1FE05DF84F2081318180918507CC |
| :10555000482F55274217530734F4452821F081E09E |
| :105560008093700411C0F401EE0FFF1FE05DF84F4F |
| :105570002081318180918607DA01A81BB1092A17A1 |
| :105580003B0714F410927004F401EE0FFF1FE05D6E |
| :10559000F84F80819181AA27BB27A41BB50B8A17DE |
| :1055A0009B0734F463FF04C081E08093710417C04B |
| :1055B00080917104882399F0880C991CE0E3F7E04E |
| :1055C0008E0E9F1EF40120813181809186079927DC |
| :1055D000841B950B8217930714F410927104F30146 |
| :1055E000EE0FFF1FE05DF84F80819181481759074A |
| :1055F00034F460FF04C081E08093730415C080918F |
| :105600007304882389F0F301EE0FFF1FE05DF84F6C |
| :105610002081318180918607FA01E81BF1092E175C |
| :105620003F0714F410927304F301EE0FFF1FE05DC7 |
| :10563000F84F808191818A179B0734F461FF04C081 |
| :1056400081E08093720417C080917204882399F0DE |
| :10565000660C771C20E337E0620E731ED3012D9198 |
| :105660003C91809186079927841B950B821793079D |
| :1056700014F41092720480917004882321F48091B4 |
| :105680007104882321F081E080936F0402C010929E |
| :105690006F0480917304882321F48091720488231D |
| :1056A00051F081E080936E0410926F0410927004A8 |
| :1056B000109271040EC010926E0480916F048823C2 |
| :1056C00011F40C94123A84E690E09093C503809311 |
| :1056D000C403809184079927E981FA818E179F0777 |
| :1056E00014F49A83898380915004882341F11092A5 |
| :1056F0006404109263041092600410925F0410928C |
| :105700006204109261048DEC9CECACECBDE38093E0 |
| :10571000D9079093DA07A093DB07B093DC078AE000 |
| :1057200097EDA3EABBE38093C9079093CA07A093C0 |
| :10573000CB07B093CC0710926F0410926E04809147 |
| :10574000BF079091C007A091C107B091C2072091F7 |
| :105750000E0430910F044091100450911104820FF7 |
| :10576000931FA41FB51F8093BF079093C007A093FA |
| :10577000C107B093C2078091C3079091C407A0915D |
| :10578000C507B091C60720911604309117044091C7 |
| :10579000180450911904820F931FA41FB51F809302 |
| :1057A000C3079093C407A093C507B093C607809121 |
| :1057B000B3079091B407A091B507B091B6072091B7 |
| :1057C0001204309113044091140450911504820F77 |
| :1057D000931FA41FB51F8093B3079093B407A093A2 |
| :1057E000B507B093B6078091A9079091AA07A09139 |
| :1057F000AB07B091AC0720911A0430911B04409183 |
| :105800001C0450911D04820F931FA41FB51F809389 |
| :10581000A9079093AA07A093AB07B093AC07509049 |
| :105820006E04552011F00C94723A80916F04882315 |
| :1058300011F00C94723A0C941A3AF0EE6F16FFEFD6 |
| :105840007F06FFEF8F06FFEF9F0644F4E0EE6E2E1B |
| :10585000EFEF7E2EEFEF8E2EEFEF9E2E21323105F1 |
| :105860004105510534F070E2E72EF12C012D112D88 |
| :105870000DC0205E3F4F4F4F5F4F44F460EEE62E69 |
| :105880006FEFF62E6FEF062F6FEF162F80912E041D |
| :1058900090912F04A0913004B0913104861997099A |
| :1058A000A809B90980932E0490932F04A093300483 |
| :1058B000B09331048091360490913704A09138045C |
| :1058C000B09139048E199F09A00BB10B8093360457 |
| :1058D00090933704A0933804B09339048091E40383 |
| :1058E0009091E5038F3F910509F008F4B0C455206D |
| :1058F00009F031C480916F04882309F02CC46091B1 |
| :10590000BF077091C0078091C1079091C20720E046 |
| :1059100031E040E050E00E94F6462093BF0730930C |
| :10592000C0074093C1075093C2076091C3077091AD |
| :10593000C4078091C5079091C60720E031E040E0A0 |
| :1059400050E00E94F6462093C3073093C40740936B |
| :10595000C5075093C607E0907207FF240027112760 |
| :1059600020911E0430911F04409120045091210485 |
| :10597000C801B7010E94824620E031E040E050E0DB |
| :105980000E94F64620931E0430931F044093200487 |
| :105990005093210420912204309123044091240447 |
| :1059A00050912504C801B7010E94824620E031E0F1 |
| :1059B00040E050E00E94F6462093220430932304F6 |
| :1059C0004093240450932504609126047091270489 |
| :1059D000809128049091290420E031E040E050E0DB |
| :1059E0000E94F6462093260430932704409328040F |
| :1059F000509329046091BF077091C0078091C1073F |
| :105A00009091C20720911E0430911F044091200400 |
| :105A100050912104E0908B07FF2400271127621B7F |
| :105A2000730B840B950BA80197010E94F6462093F7 |
| :105A300098043093990440939A0450939B04CA01AC |
| :105A4000B90120E031E040E050E00E94F6466901F3 |
| :105A500030936D0420936C046091C3077091C40768 |
| :105A60008091C5079091C6072091220430912304AC |
| :105A70004091240450912504621B730B840B950BF9 |
| :105A8000A80197010E94F646CA01B90120E031E061 |
| :105A900040E050E00E94F646290130936B042093C9 |
| :105AA0006A046091B3077091B4078091B507909133 |
| :105AB000B60720E031E040E050E00E94F646209337 |
| :105AC000B3073093B4074093B5075093B60760917E |
| :105AD000A9077091AA078091AB079091AC0720E0CD |
| :105AE00031E040E050E00E94F6462093A907309351 |
| :105AF000AA074093AB075093AC07E0901204F090D4 |
| :105B00001304009114041091150480910E049091D7 |
| :105B10000F04A0911004B0911104E81AF90A0A0BBD |
| :105B20001B0BE092B304F092B4040093B5041093FD |
| :105B3000B60460901A0470901B0480901C0490902E |
| :105B40001D048091160490911704A0911804B0913F |
| :105B50001904681A790A8A0A9B0A6092AF04709243 |
| :105B6000B0048092B1049092B204E092AB04F0923F |
| :105B7000AC040093AD041093AE046092A70470923D |
| :105B8000A8048092A9049092AA0480913204909172 |
| :105B90003304A0913404B09135048E199F09A00BF1 |
| :105BA000B10B8093320490933304A0933404B093E8 |
| :105BB000350480913A0490913B04A0913C04B0914B |
| :105BC0003D0486199709A809B90980933A0490936E |
| :105BD0003B04A0933C04B0933D048091E507909171 |
| :105BE000E607A091E707B091E807803274E29707D3 |
| :105BF00077E0A70770E0B70764F080529442A740AF |
| :105C0000B0408093E5079093E607A093E707B09331 |
| :105C1000E8078091E5079091E607A091E707B0912A |
| :105C2000E807B7FF0CC0805E9B4DA84FBF4F809325 |
| :105C3000E5079093E607A093E707B093E807809104 |
| :105C400000018A3011F4289801C0289A81E090E080 |
| :105C500090939304809392048091BF079091C00722 |
| :105C6000A091C107B091C20720918A0430918B04A2 |
| :105C700040918C0450918D04281B390B4A0B5B0B0F |
| :105C800057FF07C050954095309521953F4F4F4F96 |
| :105C90005F4F20523E44404050400CF0B9C091E06C |
| :105CA000E91690E1F90690E0090790E019070CF475 |
| :105CB0004EC080919104882309F445C0D801C701E2 |
| :105CC0005CE0B595A795979587955A95D1F701967C |
| :105CD0009093930480939204D801C70143E0B59553 |
| :105CE000A795979587954A95D1F7809398049093B7 |
| :105CF0009904A0939A04B0939B0489589341A040BF |
| :105D0000B04064F088E893E1A0E0B0E080939804AC |
| :105D100090939904A0939A04B0939B046091980483 |
| :105D20007091990480919A0490919B0420E031E055 |
| :105D300040E050E00E94F646C20ED31ED0926D04A1 |
| :105D4000C0926C0462C081E0809391045EC01092A6 |
| :105D50009104F0E0EF16F0EFFF06FFEF0F07FFEF03 |
| :105D60001F070CF052C080919004882309F449C0A9 |
| :105D700088279927DC018E199F09A00BB10B3CE005 |
| :105D8000B595A795979587953A95D1F701969093F4 |
| :105D9000930480939204C801B70128E030E040E00A |
| :105DA00050E00E94F6462093980430939904409363 |
| :105DB0009A0450939B0428573C4E4F4F5F4F64F416 |
| :105DC00088E79CEEAFEFBFEF80939804909399041F |
| :105DD000A0939A04B0939B046091980470919904E5 |
| :105DE00080919A0490919B0420E031E040E050E0E3 |
| :105DF0000E94F646C20ED31ED0926D04C0926C046F |
| :105E00000BC081E08093900407C01092900404C0FE |
| :105E100010929304109292048091D4079091D50728 |
| :105E20002091DE073091DF0797FF03C090958195A1 |
| :105E30009F4F843691050CF043C0C90137FF03C062 |
| :105E4000909581959F4F84369105D4F580918C076C |
| :105E5000282F3327809192049091930428173907B3 |
| :105E600024F4309393042093920471E0E71674E0D5 |
| :105E7000F70670E0070770E017075CF08091FA03FF |
| :105E80009091FB032091920430919304820F931F11 |
| :105E900013C080E0E8168CEFF8068FEF08078FEF4D |
| :105EA000180774F48091FA039091FB0320919204F7 |
| :105EB00030919304821B930B9093FB038093FA031E |
| :105EC00081E090E090939304809392041092940464 |
| :105ED0001092950410929604109297048091C30733 |
| :105EE0009091C407A091C507B091C6072091860480 |
| :105EF000309187044091880450918904281B390B04 |
| :105F00004A0B5B0B57FF07C0509540953095219584 |
| :105F10003F4F4F4F5F4F20523E44404050400CF0A7 |
| :105F2000B9C0A1E06A16A0E17A06A0E08A06A0E066 |
| :105F30009A060CF44EC080918F04882309F445C062 |
| :105F4000D401C3012CE0B595A795979587952A951F |
| :105F5000D1F701969093930480939204D401C301E6 |
| :105F600003E0B595A795979587950A95D1F7809306 |
| :105F7000940490939504A0939604B0939704895841 |
| :105F80009341A040B04064F088E893E1A0E0B0E025 |
| :105F90008093940490939504A0939604B0939704EF |
| :105FA0006091940470919504809196049091970467 |
| :105FB00020E031E040E050E00E94F646420E531EE1 |
| :105FC00050926B0440926A0462C081E080938F0417 |
| :105FD0005EC010928F04F0E06F16F0EF7F06FFEFC7 |
| :105FE0008F06FFEF9F060CF052C080918E0488232D |
| :105FF00009F449C088279927DC0186199709A8095F |
| :10600000B9091CE0B595A795979587951A95D1F78D |
| :1060100001969093930480939204C401B30128E005 |
| :1060200030E040E050E00E94F64620939404309324 |
| :106030009504409396045093970428573C4E4F4F35 |
| :106040005F4F64F488E79CEEAFEFBFEF809394045A |
| :1060500090939504A0939604B09397046091940450 |
| :1060600070919504809196049091970420E031E01E |
| :1060700040E050E00E94F646420E531E50926B04E0 |
| :1060800040926A040BC081E080938E0407C0109296 |
| :106090008E0404C010929304109292042091D407AD |
| :1060A0003091D50737FF03C0309521953F4F30938E |
| :1060B000B2072093B1078091DE079091DF0797FF29 |
| :1060C00003C0909581959F4F9093D0078093CF0701 |
| :1060D000243631050CF047C0843691050CF043C0DE |
| :1060E00080918C07282F33278091920490919304FC |
| :1060F0002817390724F4309393042093920471E015 |
| :10610000671674E0770670E0870670E097065CF02B |
| :106110008091FC039091FD032091920430919304AF |
| :10612000820F931F13C080E068168CEF78068FEF04 |
| :1061300088068FEF9806BCF48091FC039091FD03D4 |
| :106140002091920430919304821B930B9093FD0352 |
| :106150008093FC0308C010926B0410926A041092A2 |
| :106160006D0410926C0420E030E040E050E060915B |
| :10617000C9077091CA078091CB079091CC070E9404 |
| :10618000CA45882341F410926B0410926A0410925D |
| :106190006D0410926C048091BF079091C007A0918C |
| :1061A000C107B091C20780938A0490938B04A09397 |
| :1061B0008C04B0938D048091C3079091C407A09183 |
| :1061C000C507B091C6078093860490938704A09377 |
| :1061D0008804B093890410921E0410921F04109238 |
| :1061E0002004109221041092220410922304109291 |
| :1061F0002404109225041092260410922704109271 |
| :106200002804109229041092BF071092C007109220 |
| :10621000C1071092C2071092C3071092C4071092D0 |
| :10622000C5071092C6071092B3071092B4071092D8 |
| :10623000B5071092B6071092A9071092AA071092FC |
| :10624000AB071092AC071092E5031092E403809123 |
| :10625000C803882309F46AC11092C8032091D407A7 |
| :106260003091D50737FF03C0309521953F4F3093CC |
| :10627000B2072093B1078091DE079091DF0797FF67 |
| :1062800003C0909581959F4F9093D0078093CF073F |
| :10629000243631050CF038C1843691050CF034C138 |
| :1062A00020914A0430914B048091C9039091CA0314 |
| :1062B000281B390B37FF03C0309521953F4F2630FF |
| :1062C00031050CF02BC180916304909164044396D6 |
| :1062D000879708F08DC080915404909155048F3FAA |
| :1062E00091052CF401969093550480935404809169 |
| :1062F00054049091550402970CF48EC06091B90734 |
| :106300007091BA078091BB079091BC0724E135E0FA |
| :1063100040E050E00E94F646B9013093B207209366 |
| :10632000B10720914A0430914B0480915C07909111 |
| :106330005D07281B390B3093D0072093CF079FEFC1 |
| :106340002C34390734F428593E4F3093D00720932A |
| :10635000CF078091CF079091D007853B910534F00E |
| :10636000885691409093D0078093CF078091CF07B4 |
| :106370009091D007DB01A81BB90BCD01B093D007DA |
| :10638000A093CF0715971CF084E090E005C08C5FC8 |
| :106390009F4F34F48CEF9FEF9093D0078093CF07FB |
| :1063A0009B0177FF03C0309521953F4F2230310587 |
| :1063B0009CF11092B9071092BA071092BB07109285 |
| :1063C000BC0780914A0490914B0490935D078093A1 |
| :1063D0005C078091FE039091FF032091CF073091DD |
| :1063E000D007821B930B9093FF038093FE0314C08E |
| :1063F00080914A0490914B0490935D0780935C07D1 |
| :1064000010925504109254041092B9071092BA07D2 |
| :106410001092BB071092BC0781E0809352046091F8 |
| :10642000E5077091E6078091E7079091E80724E17E |
| :1064300035E040E050E00E94F6462093E5073093B7 |
| :10644000E6074093E7075093E80760914A0470918C |
| :106450004B04621B730B7093B2076093B107CB01BF |
| :106460000197833B910588F0643B710534F4CB01BF |
| :106470008C549F4F843B910528F42150304040407C |
| :10648000504007C06C547F4F64F42F5F3F4F4F4F15 |
| :106490005F4F2093E5073093E6074093E70750935B |
| :1064A000E8078091E5079091E607A091E707B09192 |
| :1064B000E807B7FF0CC088599E4FAF4FBF4F80937E |
| :1064C000E5079093E607A093E707B093E80760918C |
| :1064D000E5077091E6078091E7079091E80728E6C5 |
| :1064E00031E040E050E00E94F64624E135E040E033 |
| :1064F00050E00E9482466093E5077093E607809320 |
| :10650000E7079093E8070AC0109252041092B90767 |
| :106510001092BA071092BB071092BC0780914A04F0 |
| :1065200090914B049093CA038093C90380916607AE |
| :1065300085FF43C0E0915E07FF27EE0FFF1FE05D80 |
| :10654000F84F0190F081E02DF7FF03C0F095E19541 |
| :10655000FF4F3F9794F5E0915F07FF27EE0FFF1F76 |
| :10656000E05DF84F0190F081E02DF7FF03C0F0955A |
| :10657000E195FF4F3F970CF580915C0890915D0885 |
| :10658000892BD9F029813A812F313105B4F08091DE |
| :10659000940390915304893C20F0933021F084E0DF |
| :1065A00006C0943019F41092530403C083E0809322 |
| :1065B000530480915304992708C080915304882381 |
| :1065C00031F01092530480E090E00E943D3D8090B5 |
| :1065D0003F08909040088114910409F0429860901F |
| :1065E000630470906404930177FE04C0222733276C |
| :1065F00026193709253131053CF08091660784FD65 |
| :1066000003C081E080939C04E0906F075901CC2483 |
| :10661000B7FCC094DC2CB301882777FD8095982FB8 |
| :106620002E2D3327442755270E9482469B01AC011B |
| :10663000C601B5010E94824620E032E040E050E011 |
| :106640000E94F64689019A01FF24E69CC001E79C5E |
| :10665000900DF69C900D112464E070E00E94C146FC |
| :10666000600F711FCB01AA2797FDA095BA2F8987CC |
| :106670009A87AB87BC878093B7049093B804A093A4 |
| :10668000B904B093BA0480913E0490913F04A09164 |
| :106690004004B091410429853A854B855C85821B75 |
| :1066A000930BA40BB50B80933E0490933F04A093EF |
| :1066B0004004B093410480913E0490913F04A09126 |
| :1066C0004004B09141048155934CA040B04064F027 |
| :1066D00080E593ECA0E0B0E080933E0490933F040B |
| :1066E000A0934004B093410480913E0490913F04F4 |
| :1066F000A0914004B0914104805B9C43AF4FBF4FD9 |
| :1067000064F480EB9CE3AFEFBFEF80933E04909383 |
| :106710003F04A0934004B093410480914A049091B7 |
| :106720004B04892B09F461C08091660783FF5DC02B |
| :106730008091CB039091CC03892B09F456C0209112 |
| :10674000CF073091D0078091B1079091B20782179F |
| :10675000930724F43093B2072093B1072091520499 |
| :10676000222371F080919C04882351F080914A0487 |
| :1067700090914B0490934D0480934C0410929C0490 |
| :1067800080919703482F55275093B2074093B10744 |
| :106790001416150654F5222341F100913E04109180 |
| :1067A0003F04209140043091410480914E04909127 |
| :1067B0004F04BC01649FC001659F900D749F900DB4 |
| :1067C000112460E270E00E94C146882777FD809521 |
| :1067D000982F060F171F281F391F00933E04109390 |
| :1067E0003F04209340043093410480919D048150E4 |
| :1067F00080939D048F3F09F02AC188E180939D0416 |
| :106800008091C4039091C503209104033091050346 |
| :1068100082239323892B29F488B194E0892788B9AE |
| :1068200007C080916504882311F0429A01C0429804 |
| :1068300060910E0470910F048091100490911104E6 |
| :10684000E0907207FF2400271127A80197010E94FA |
| :10685000F6463093D6062093D506609116047091C3 |
| :1068600017048091180490911904A80197010E94BF |
| :10687000F6463093D8062093D7068091D40790919E |
| :10688000D5079093DA068093D9068091DE07909120 |
| :10689000DF079093DC068093DB068091D707909109 |
| :1068A000D8079093DE068093DD0680916604909170 |
| :1068B00067049093E0068093DF0660914604709130 |
| :1068C0004704809148049091490420E032E040E080 |
| :1068D00050E00E94F6463093E2062093E106809154 |
| :1068E0004A0490914B049093E6068093E5066091EC |
| :1068F000E5077091E6078091E7079091E80724E1AA |
| :1069000035E040E050E00E94F6463093E8062093E0 |
| :10691000E7068091B5039091B6039093F6068093B5 |
| :10692000F50680910803909109039093F8068093EF |
| :10693000F7068091AE079091AF079093FA06809387 |
| :10694000F9068091A6079091A7079093FC06809383 |
| :10695000FB068091D7079091D8079093FE0680930D |
| :10696000FD0680915F0490916004909300078093EE |
| :10697000FF068091610490916204909302078093D6 |
| :1069800001077092040760920307809174049927AD |
| :106990009093EA068093E906809176049927909374 |
| :1069A000EC068093EB068091CF049091D0049093F5 |
| :1069B0000607809305078091D1049091D2049093AB |
| :1069C00008078093070780916B0890916C0890935B |
| :1069D0000A078093090780916D0890916E08909343 |
| :1069E0000C0780930B0780916F089091700890932B |
| :1069F0000E0780930D072091530482E3289F900196 |
| :106A000011248091780890917908AC01E3E0440F5B |
| :106A1000551FEA95E1F7880F991F840F951F880E7F |
| :106A2000991E280D391D3093100720930F07809170 |
| :106A30005E0890915F0890931207809311078091F0 |
| :106A4000B9079091BA079093140780931307809128 |
| :106A50006E048823A9F06091AE077091AF07882774 |
| :106A600077FD8095982F0E94C0452091D9073091DD |
| :106A7000DA074091DB075091DC070E943A4632C0AA |
| :106A800060910E0470910F04809110049091110494 |
| :106A9000E090AE07F090AF070E94C0452091C90773 |
| :106AA0003091CA074091CB075091CC070E943A46DB |
| :106AB0005B016C010027F7FC0095102FC801B7019E |
| :106AC0000E94C0452091D9073091DA074091DB0739 |
| :106AD0005091DC070E943A469B01AC01C601B5010A |
| :106AE0000E941B450E94A3457093AF076093AE07B9 |
| :106AF00080916F048823A9F06091A6077091A70781 |
| :106B0000882777FD8095982F0E94C0452091D9074E |
| :106B10003091DA074091DB075091DC070E943A463A |
| :106B200032C06091160470911704809118049091FE |
| :106B30001904E090A607F090A7070E94C045209195 |
| :106B4000C9073091CA074091CB075091CC070E94EA |
| :106B50003A465B016C010027F7FC0095102FC80135 |
| :106B6000B7010E94C0452091D9073091DA074091C2 |
| :106B7000DB075091DC070E943A469B01AC01C6013D |
| :106B8000B5010E941B450E94A3457093A70760931F |
| :106B9000A6076091D7077091D807E0902A04F0907B |
| :106BA0002B0400912C0410912D048091C907909121 |
| :106BB000CA07A091CB07B091CC078D879E87AF877E |
| :106BC000B88B882777FD8095982F0E94C04520912B |
| :106BD000D9073091DA074091DB075091DC070E941A |
| :106BE0003A465B016C01C801B7010E94C0452D8582 |
| :106BF0003E854F8558890E943A4620E030E040E0CB |
| :106C00005FE30E943A469B01AC01C601B5010E94B8 |
| :106C10001B450E94A3457093D8076093D7078091C6 |
| :106C2000AE079091AF078150984034F080E098E033 |
| :106C30009093AF078093AE078091AE079091AF0716 |
| :106C40008050984F34F480E098EF9093AF07809392 |
| :106C5000AE078091A6079091A7078150984034F025 |
| :106C600080E098E09093A7078093A6078091A607FD |
| :106C70009091A7078050984F34F480E098EF90935C |
| :106C8000A7078093A6078091D7079091D8078150D6 |
| :106C9000984034F080E098E09093D8078093D7072D |
| :106CA0008091D7079091D8078050984F34F480E0B6 |
| :106CB00098EF9093D8078093D7078091660799271C |
| :106CC00080FFD9C04091940381FF0EC0423310F57C |
| :106CD000809166049091670444979093690480932F |
| :106CE00068041092510419C020919F033091A003B1 |
| :106CF000240F311D80916B079927AC01249FC0019F |
| :106D0000259F900D349F900D112444979093690412 |
| :106D10008093680481E0809351048091500488231B |
| :106D200021F0109269041092680420916604309159 |
| :106D300067044091680450916904421753070CF0AE |
| :106D40009AC080915104882309F495C0241B350B07 |
| :106D5000809195039927BC01269FC001279F900D24 |
| :106D6000369F900D112460E170E00E94C1460981B8 |
| :106D70001A81061B170B2091E2033091E3038091E7 |
| :106D800093039927DC012A9FC0012B9F900D3A9F06 |
| :106D9000900D112468E070E00E94C146061B170B9D |
| :106DA0006091460470914704809148049091490491 |
| :106DB00020E032E040E050E00E94F646CA01B9010E |
| :106DC000209196033327442755270E94824620E2CC |
| :106DD00030E040E050E00E94F646BFEF2E3C3B071B |
| :106DE00014F42EEC3FEF80919E0490919F04AC012F |
| :106DF00064E0440F551F6A95E1F7481B590B233394 |
| :106E0000310514F022E330E0021B130BCA01800F9E |
| :106E1000911F60E170E00E94C14670939F046093EF |
| :106E20009E04809167079927681779078CF4E98198 |
| :106E3000FA81E817F9072CF090939F0480939E0441 |
| :106E400007C029813A8130939F0420939E040DC08E |
| :106E500080919E0490919F0449815A814817590757 |
| :106E600024F450939F0440939E0460919E0470917B |
| :106E70009F047A83698389819A819093E406809341 |
| :106E8000E3060091D7071091D8078091D607482EC6 |
| :106E90005524A981BA8154971CF41C821B822DC0F1 |
| :106EA00089819A8162E070E00E94C1469B01B8012D |
| :106EB000E985FA856E1B7F0BC901621773070CF415 |
| :106EC000CB0166277727621B730B681779070CF4D1 |
| :106ED000BC01C20129813A81821B930B6817790793 |
| :106EE0000CF4CB0149815A81441955095C834B83C9 |
| :106EF0004817590714F49C838B832091AE07309177 |
| :106F0000AF0780905F04909060048091CF049091CF |
| :106F1000D004881A990A281939093093BE0720939A |
| :106F2000BD0720E030E040E050E06D857E858F8534 |
| :106F300098890E94CA458823F1F1E0900E04F090F0 |
| :106F40000F0400911004109111046091BF0470911E |
| :106F5000C0048091C1049091C2040E94C0455B01AD |
| :106F60006C01C801B7010E94C0452D853E854F8543 |
| :106F700058890E943A467B018C01B401882777FD2D |
| :106F80008095982F0E94C0459B01AC01C801B701B4 |
| :106F90000E941A459B01AC01C601B5010E941B4528 |
| :106FA0000E94A3456093BF047093C0048093C10402 |
| :106FB0009093C2041CC02091BD073091BE074427A6 |
| :106FC00037FD4095542F8091BF049091C004A0914B |
| :106FD000C104B091C204820F931FA41FB51F8093F8 |
| :106FE000BF049093C004A093C104B093C2048091E5 |
| :106FF000BF049091C004A091C104B091C2041816BE |
| :1070000019061A061B0624F40297A109B10903C048 |
| :107010000296A11DB11D8093BF049093C004A0935C |
| :10702000C104B093C2048091BF049091C004A091A8 |
| :10703000C104B091C20481385EE3950750E0A50712 |
| :1070400050E0B5072CF080E89EE3A0E0B0E009C076 |
| :107050008058914CAF4FBF4F64F480E891ECAFEF94 |
| :10706000BFEF8093BF049093C004A093C104B0937A |
| :10707000C2046091BD077091BE0780918F0390910B |
| :107080009003A0919103B09192038D839E83AF836F |
| :10709000B887882777FD8095982F0E94C0457B018F |
| :1070A0008C016091BF047091C0048091C1049091E3 |
| :1070B000C2040E94C0459B01AC016D817E818F811D |
| :1070C00098850E943A469B01AC01C801B7010E9415 |
| :1070D0001B450E94A3453B014C016B0180919E031F |
| :1070E000E82EFF24002711278B819C8197FF03C086 |
| :1070F000909581959F4F62E070E00E94C1469B0190 |
| :10710000A981BA812A0F3B1F442737FD4095542F90 |
| :10711000C801B7010E94824620E430E040E050E020 |
| :107120000E94F6461901C216D3060CF49301662498 |
| :10713000772462187308A301621673060CF4A90180 |
| :1071400089819A81EB81FC818E0F9F1F840F951F8F |
| :1071500097FF03C020E030E005C09201841595053B |
| :107160000CF49C018091B007882E9924C4018216EA |
| :1071700093060CF4C9018093A80789819A81841B26 |
| :10718000950B2B813C81820F931F97FF03C020E05A |
| :1071900030E005C09201841595050CF49C01C401F2 |
| :1071A000821693060CF4C9018093AD072091A607BF |
| :1071B0003091A70740916104509162048091D104FD |
| :1071C0009091D204481B590B588F4F8B241B350BC1 |
| :1071D0003093A5072093A40720E030E040E050E082 |
| :1071E0006D857E858F8598890E94CA45882309F41C |
| :1071F00040C0E0901604F09017040091180410911C |
| :1072000019046091BB047091BC048091BD049091FD |
| :10721000BE040E94C0455B016C01C801B7010E9419 |
| :10722000C0452D853E854F8558890E943A467B0191 |
| :107230008C01AF89B88DBD01882777FD8095982F87 |
| :107240000E94C0459B01AC01C801B7010E941A45CC |
| :107250009B01AC01C601B5010E941B450E94A345DC |
| :107260006093BB047093BC048093BD049093BE04F0 |
| :107270001CC02091A4073091A507442737FD4095F5 |
| :10728000542F8091BB049091BC04A091BD04B09197 |
| :10729000BE04820F931FA41FB51F8093BB0490935D |
| :1072A000BC04A093BD04B093BE048091BB04909134 |
| :1072B000BC04A091BD04B091BE04181619061A06AC |
| :1072C0001B0624F40297A109B10903C00296A11D6F |
| :1072D000B11D8093BB049093BC04A093BD04B093F4 |
| :1072E000BE048091BB049091BC04A091BD04B091F8 |
| :1072F000BE048138EEE39E07E0E0AE07E0E0BE07A3 |
| :107300002CF080E89EE3A0E0B0E009C08058914CEA |
| :10731000AF4FBF4F64F480E891ECAFEFBFEF8093C5 |
| :10732000BB049093BC04A093BD04B093BE046091D1 |
| :10733000A4077091A507882777FD8095982F0E9454 |
| :10734000C0457B018C016091BB047091BC048091AD |
| :10735000BD049091BE040E94C0459B01AC016D81AB |
| :107360007E818F8198850E943A469B01AC01C801BD |
| :10737000B7010E941B450E94A34591016215730548 |
| :107380000CF49B01C301621673060CF4C901498118 |
| :107390005A81480F591F2B813C81421B530B57FFC9 |
| :1073A00003C020E030E005C09201441555050CF4FF |
| :1073B0009A01A401821693060CF4A9014093D10707 |
| :1073C00029813A81281B390B4B815C81241B350BA9 |
| :1073D00037FF03C040E050E005C0A2012415350589 |
| :1073E0000CF4A901C401841695060CF0D9C0CA0199 |
| :1073F000D7C020917E0430917F04C90113E0880F2B |
| :10740000991F1A95E1F7821B930B68E070E00E94C8 |
| :10741000C1468B0170937F0460937E0440E050E08E |
| :107420000C94FE2880916E04882311F40C94732B25 |
| :107430000C94692B60910E0470910F0480911004DC |
| :1074400090911104A0907207BB24CC24DD24E0901D |
| :10745000D407F090D507A60195010E94F6460027B3 |
| :10746000F7FC0095102F2E193F09400B510BCA0154 |
| :10747000B90120E130E040E050E00E94F6463901D9 |
| :107480004A0160911604709117048091180490913C |
| :107490001904E090DE07F090DF07A60195010E9435 |
| :1074A000F6460027F7FC0095102F2E193F09400BD8 |
| :1074B000510BCA01B90120E130E040E050E00E94E8 |
| :1074C000F64679018A0161E266167104810491042D |
| :1074D00014F40C941D2CB0E26B2E712C812C912C89 |
| :1074E0000C942E2C10921E0410921F041092200453 |
| :1074F000109221041092220410922304109224046A |
| :10750000109225041092BF071092C0071092C10775 |
| :107510001092C2071092C3071092C4071092C507B9 |
| :107520001092C6071092B3071092B4071092B507D5 |
| :107530001092B6071092A9071092AA071092AB07F3 |
| :107540001092AC0780912E0490912F04A0913004EA |
| :10755000B09131048093320490933304A0933404A7 |
| :10756000B09335048091360490913704A09138048B |
| :10757000B091390480933A0490933B04A0933C0467 |
| :10758000B0933D041092E5031092E40310926D0451 |
| :1075900010926C0410926B0410926A040C946E2C7E |
| :1075A0008093CD076A960FB6F894DEBF0FBECDBFAD |
| :1075B000DF91CF911F910F91FF90EF90DF90CF90CF |
| :1075C000BF90AF909F908F907F906F905F904F9003 |
| :1075D0003F902F9008951092D4041092D3041092EB |
| :1075E000400810923F081092790810927808109283 |
| :1075F0002B0810920D0810928A0810923E081092E3 |
| :107600005308109271081092D0041092CF04109277 |
| :10761000D2041092D104109277081092760810923A |
| :107620005B0810925A0810921808109217081092CE |
| :107630005D0810925C08089580912B08882319F446 |
| :1076400081E090E0089580918A08882309F46AC057 |
| :1076500080910D08882309F465C080917E089927E0 |
| :107660008370907002970CF452C080917F0880FF65 |
| :107670004EC010928A0860911D0870911E0880917A |
| :107680001F08909120082AE030E040E050E00E947E |
| :10769000F6462093410830934208409343085093A4 |
| :1076A00044086091210870912208809123089091EC |
| :1076B00024082AE030E040E050E00E94F6462093A3 |
| :1076C0004508309346084093470850934808609116 |
| :1076D00025087091260880912708909128082AE0B3 |
| :1076E00030E040E050E00E94F64620934908309395 |
| :1076F0004A0840934B0850934C0810922B08109264 |
| :107700000D0881E08093530880E090E00895109286 |
| :10771000530810920D0810928A0810922B0882E0EC |
| :1077200090E0089581E090E008950E941C3B1816B7 |
| :1077300019060CF44CC080915C0890915D0823E020 |
| :10774000883E920730F4885A9D4F90935D0880934D |
| :107750005C0880913E088823B1F1809141089091A6 |
| :10776000420820912C0830912D08821B930B909396 |
| :107770006C0880936B088091450890914608209191 |
| :10778000300830913108821B930B90936E088093E0 |
| :107790006D088091490890914A08209134083091F1 |
| :1077A0003508821B930B9093700880936F0881E0DB |
| :1077B0008093710881E090E0909377088093760839 |
| :1077C00080E090E008951092710882E090E00895C2 |
| :1077D0000E941C3B892B99F58091410890914208A9 |
| :1077E000A0914308B091440880932C0890932D08F1 |
| :1077F000A0932E08B0932F088091450890914608D9 |
| :10780000A0914708B09148088093300890933108C0 |
| :10781000A0933208B09333088091490890914A08A8 |
| :10782000A0914B08B0914C08809334089093350890 |
| :10783000A0933608B093370881E080933E080895FE |
| :10784000482F2091D3043091D4042530310509F418 |
| :107850009AC0263031058CF42130310529F12230CF |
| :1078600031051CF4232BD1F003C12230310571F115 |
| :107870002330310509F0FCC02FC02730310509F451 |
| :10788000E2C0273031050CF490C02830310509F4EE |
| :10789000E5C02930310509F0EBC0A2C0853B09F0F5 |
| :1078A000E7C081E090E0D5C0823639F482E090E014 |
| :1078B0009093D4048093D30404C01092D404109203 |
| :1078C000D3041092E9041092EA040895813009F07B |
| :1078D000CFC083E090E0BDC0883031F0823151F1FB |
| :1078E000833009F044C013C02BE238E03093F80431 |
| :1078F0002093F70480912B088823C9F5225130404A |
| :107900003093F6042093F5042E5E3F4F25C02AE8FD |
| :1079100038E03093F8042093F70480918A08882394 |
| :1079200031F5205130403093F6042093F504205F68 |
| :107930003F4F12C02DE038E03093F8042093F70455 |
| :1079400080910D08882399F4245230403093F60436 |
| :107950002093F5042C5D3F4F3093EE042093ED040B |
| :1079600085E090E09093D4048093D30404C01092F7 |
| :10797000D4041092D304842F8F5F8093E9048F5F27 |
| :107980008093EA04089599279093EC048093EB0484 |
| :107990009091E904940F9093E9048091EA04890F8F |
| :1079A0008093EA0486E090E054C0282F3327322FDA |
| :1079B00022278091EB049091EC04820F931F909307 |
| :1079C000EC048093EB049091E904940F9093E90404 |
| :1079D0008091EA04890F8093EA0489E090E039C03D |
| :1079E0006091EB047091EC046115710509F440C0DD |
| :1079F000E091F504F091F60480838091E904840F0E |
| :107A00008093E9049091EA04980F9093EA04CB01E3 |
| :107A100001979093EC048093EB04892B89F080917B |
| :107A2000ED049091EE048E179F0750F03196F0937D |
| :107A3000F604E093F5043093D4042093D30408951E |
| :107A400087E090E006C08091E904481789F488E057 |
| :107A500090E09093D4048093D30408958091EA0435 |
| :107A6000481731F4E091F704F091F80481E0808345 |
| :107A70001092D4041092D30408952F923F924F9203 |
| :107A80005F926F927F928F929F92AF92BF92CF92AE |
| :107A9000DF92EF92FF920F931F93CF93DF933C01FE |
| :107AA0008330910509F4C4C08430910521F0892BFD |
| :107AB00009F422C1BAC020913F0830914008C901A1 |
| :107AC0000197029708F435C18091E7049091E8048A |
| :107AD00001969093E8048093E7048159914008F45B |
| :107AE000F7C51092E8041092E7041092F004109287 |
| :107AF000EF041092F2041092F1041092F404109228 |
| :107B0000F3041092E6041092E5041092E40410923B |
| :107B1000E304109273081092720810927508109284 |
| :107B200074081092E0041092DF041092E2041092A4 |
| :107B3000E1041092DA041092D9041092D804109241 |
| :107B4000D7041092DE041092DD041092DC0410922F |
| :107B5000DB041092540810925508109256081092A7 |
| :107B600057081092D6041092D504109279081092FA |
| :107B7000780880917108882309F451C080916B08BE |
| :107B800090916C08909365088093640860916D08EB |
| :107B900070916E08709367086093660821E02093E7 |
| :107BA0006A089093110880931008709313086093EB |
| :107BB000120820931608709561957F4F90958195D6 |
| :107BC0009F4F0E9480439C019093590880935808CE |
| :107BD000E0916408F0916508F7FF03C08AE590E042 |
| :107BE00002C08EE091E0821B930B90935908809322 |
| :107BF0005808409158085091590860916608709152 |
| :107C00006708CF010E94BA447093610860936008CE |
| :107C100082E090E09093400880933F085CC510920A |
| :107C20006A081092400810923F0882E090E055C523 |
| :107C300080913F0890914008019709F4FAC1809122 |
| :107C4000E7049091E80401969093E8048093E70498 |
| :107C50008159914008F43CC51092E8041092E70461 |
| :107C600080917108882309F444C01092F2041092A4 |
| :107C7000F1041092F4041092F3041092E6041092AE |
| :107C8000E5041092E4041092E30410927308109239 |
| :107C9000720810927508109274081092E004109205 |
| :107CA000DF041092E2041092E1041092DA041092C0 |
| :107CB000D9041092D8041092D7041092DE041092C6 |
| :107CC000DD041092DC041092DB0480916B0890912B |
| :107CD0006C08909311088093100880916D08909122 |
| :107CE0006E08909313088093120881E08093160821 |
| :107CF0009DC11092160895CF1092E8041092E704E7 |
| :107D00001092D0041092CF041092D2041092D10499 |
| :107D100010925B0810925A081092180810921708D7 |
| :107D200010927908109278081092400810923F083B |
| :107D3000D2C42130310509F47CC12230310541F033 |
| :107D4000232B09F06ECF1092E8041092E704C3C40D |
| :107D500080916A08882309F464CF80917608909115 |
| :107D60007708181619060CF061C180917808909177 |
| :107D70007908099709F45AC18091EF049091F004B1 |
| :107D800001969093F0048093EF0460911008709135 |
| :107D9000110880916B0890916C086B01C81AD90A80 |
| :107DA000D7FE04C0D094C194D108D394E0911208B6 |
| :107DB000F091130880916D0890916E08DF01A81B67 |
| :107DC000B90BB7FF03C0B095A195BF4F20915408E0 |
| :107DD000309155084091560850915708809160089D |
| :107DE00090916108821B930B833391050CF444C07E |
| :107DF0008CE3C816D1042CF5DC971CF58091D504D2 |
| :107E00009091D6048C3091052CF401969093D60471 |
| :107E10008093D5048091D5049091D604AA2797FD2C |
| :107E2000A095BA2F280F391F4A1F5B1F20935408B3 |
| :107E300030935508409356085093570883E090E0DC |
| :107E400041C08091D5049091D604823091052CF0E8 |
| :107E500001979093D6048093D5042F5F3F4F4F4FE7 |
| :107E60005F4F209354083093550840935608509321 |
| :107E7000570884E090E026C04F970CF484C098E245 |
| :107E8000C916D1048CF498977CF42A5F3F4F4F4F6A |
| :107E90005F4F2093540830935508409356085093F1 |
| :107EA000570885E090E00EC02F5F3F4F4F4F5F4F68 |
| :107EB0002093540830935508409356085093570820 |
| :107EC00086E090E090937908809378081092F4040B |
| :107ED0001092F30481E090E09093F2048093F10417 |
| :107EE00060905408709055088090560890905708FC |
| :107EF00080915808909159080E945C447C01209020 |
| :107F0000540830905508409056085090570880917A |
| :107F10005808909159080E94B2445C010027F7FC70 |
| :107F20000095102FC401B301A80197010E94824659 |
| :107F300028EE33E040E050E00E94F646809164086D |
| :107F400090916508820F931F9093110880931008F9 |
| :107F5000CC24B7FCC094DC2CC201B101A601950170 |
| :107F60000E94824628EE33E040E050E00E94F64650 |
| :107F70008091660890916708820F931F9093130871 |
| :107F80008093120853C028E2C216D1040CF048C0F6 |
| :107F900098970CF045C087E090E090937908809323 |
| :107FA00078081092F2041092F1041092F4041092E6 |
| :107FB000F304633071051CF06350704006C03FEF5E |
| :107FC0006E3F730734F46D5F7F4F709311086093B9 |
| :107FD0001008E330F10514F0339705C04FEFEE3F82 |
| :107FE000F4072CF43396F0931308E0931208809171 |
| :107FF00010089091110803960797C0F48091120819 |
| :10800000909113080396079788F410921108109224 |
| :108010001008109213081092120889E090E002C034 |
| :1080200088E090E0909379088093780881E090E070 |
| :10803000F1CD8091760890917708181619060CF00A |
| :1080400042C310927708109276082091DF04309195 |
| :10805000E0044091E1045091E204A0901008B09037 |
| :10806000110880916B0890916C08A81AB90AB09217 |
| :10807000E004A092DF04C0911208D091130880910F |
| :108080006D0890916E08C81BD90BD093E204C09381 |
| :10809000E104C090E504D090E604CA0CDB1CD09249 |
| :1080A000E604C092E5040091E3041091E4040C0F8F |
| :1080B0001D1F1093E4040093E304F501E21BF30B8E |
| :1080C000F093DE04E093DD047E01E41AF50AF092F9 |
| :1080D000DC04E092DB048091F1049091F2042091A1 |
| :1080E000D9043091DA048090D7049090D8041816FF |
| :1080F0001906FCF4C901880F991F63E070E00E9423 |
| :10810000C1469B01CF0163E070E00E94C146260F8B |
| :10811000371F3093DA042093D904C401880F991FC4 |
| :1081200063E070E00E94C1469B01C70163E070E01C |
| :1081300022C0C90164E070E00E94C1469B01CF01EA |
| :10814000880F991F8E0F9F1F64E070E00E94C14648 |
| :10815000260F371F3093DA042093D904C40164E05A |
| :1081600070E00E94C1469B01C701880F991F8E0DC8 |
| :108170009F1D64E070E00E94C146260F371F3093B8 |
| :10818000D8042093D704C601D7FE04C088279927B6 |
| :108190008C199D098153954754F4C80117FF04C0F9 |
| :1081A00088279927801B910B8153954764F0CA1843 |
| :1081B000DB08D092E604C092E5040C1B1D0B109363 |
| :1081C000E4040093E3048091F3049091F4041816FE |
| :1081D000190644F41092E6041092E5041092E404A7 |
| :1081E0001092E304B501B7FE03C0709561957F4F0F |
| :1081F000CE01D7FF03C0909581959F4F0E94804389 |
| :108200006091E1047091E204AC018091DF049091EF |
| :10821000E0040E94BA449B01AC018091F10490916A |
| :10822000F204892B81F4CA01B90123E030E040E077 |
| :1082300050E00E94F646E9012A96C531D10594F036 |
| :10824000C4E1D0E00FC0CA01B9012AE030E040E04B |
| :1082500050E00E94F646E9012A96C031D10514F09B |
| :10826000CFE0D0E0E0907504FF2400271127609153 |
| :10827000E5047091E604882777FD8095982FA80182 |
| :1082800097010E94824620E031E040E050E00E94E9 |
| :10829000F64659016A016091E3047091E40488276D |
| :1082A00077FD8095982FA80197010E94824620E0D3 |
| :1082B00031E040E050E00E94F64680E6A8168FEFDD |
| :1082C000B8068FEFC8068FEFD80644F460E6A62EF6 |
| :1082D0006FEFB62E6FEFC62E6FEFD62E89019A0183 |
| :1082E00000369FEF19079FEF29079FEF390724F406 |
| :1082F00000E61FEF2FEF3FEF80917404869586957F |
| :108300008695E82EFF24809176048695869586953D |
| :10831000882E992441EAA416B104C104D1042CF09A |
| :1083200050EAA52EB12CC12CD12C8091DF04909164 |
| :10833000E004880F991FAC01E49EC001E59E900DFA |
| :10834000F49E900D112460E170E00E94C146FB0193 |
| :10835000EA0DFB1D8091D9049091DA04AC01849E52 |
| :10836000C001859E900D949E900D1124AC01C49F78 |
| :10837000C001C59F900DD49F900D11246AE070E05C |
| :108380000E94C146E60FF71FF0937308E09372084E |
| :1083900058016901013A1105210531052CF030EA37 |
| :1083A000A32EB12CC12CD12C8091E1049091E20438 |
| :1083B000880F991F9C01E29EC001E39E900DF29EE2 |
| :1083C000900D112460E170E00E94C1469B012A0DCE |
| :1083D0003B1D8091D7049091D804AC01849EC001CC |
| :1083E000859E900D949E900D1124AC01C49FC001F8 |
| :1083F000C59F900DD49F900D11246AE070E00E94FB |
| :10840000C146260F371F3093750820937408B901B1 |
| :10841000CF010E9480439C0190936308809362087F |
| :10842000009172081091730817FD03C08AE590E06F |
| :1084300002C08EE091E0821B930B909363088093BF |
| :108440006208C0916208D09163086091E50770915D |
| :10845000E6078091E7079091E80724E135E040E0E6 |
| :1084600050E00E94F646CE01821B930B9C01909334 |
| :108470000F0880930E08853B91057CF0C43BD10525 |
| :108480001CF0285631400FC088E691E0821B930B08 |
| :1084900090930F0880930E080AC09FEF2C34390781 |
| :1084A00034F428593E4F30930F0820930E08C090A3 |
| :1084B0007408D0907508980117FF04C0222733274D |
| :1084C000201B310BC601D7FE04C0882799278C19C1 |
| :1084D0009D098217930754F4CE010E945C447C01ED |
| :1084E000B801882777FD8095982F09C0CE010E949A |
| :1084F000B2447C01B601882777FD8095982F28EE3D |
| :1085000033E040E050E00E9482460027F7FC0095EF |
| :10851000102FA80197010E94F646B90137FF03C04A |
| :10852000709561957F4F5B01CC24B7FCC094DC2C27 |
| :10853000B0925F08A0925E0880910E0890910F089B |
| :108540000E945C449C01442737FD4095542FC6018E |
| :10855000B5010E94824628EE33E040E050E00E94E0 |
| :10856000F6463093D2042093D10480910E08909166 |
| :108570000F080E94B2449C01442737FD4095542FB8 |
| :10858000C601B5010E94824628EE33E040E050E08B |
| :108590000E94F646309521953F4F3093D0042093AA |
| :1085A000CF048091D1049091D20441E081349407AA |
| :1085B0001CF080E491E005C0805C9E4F34F480ECB8 |
| :1085C0009EEF9093D2048093D10481E02134380748 |
| :1085D0001CF080E491E005C0205C3E4F34F480EC58 |
| :1085E0009EEF9093D0048093CF048091D10490911A |
| :1085F000D2040AE510E09C01209FC001219F900D4C |
| :10860000309F900D112460E471E00E94C146CB01BF |
| :108610000E945C44AA2797FDA095BA2FBC01CD010A |
| :1086200029E130E040E050E00E94F6463093D20469 |
| :108630002093D1048091CF049091D004AC01409F4D |
| :10864000C001419F900D509F900D112460E471E096 |
| :108650000E94C146CB010E945C44AA2797FDA095C9 |
| :10866000BA2FBC01CD0129E130E040E050E00E948A |
| :10867000F6463093D0042093CF048091DF0490918C |
| :10868000E00497FF03C0909581959F4F81599140D9 |
| :1086900064F48091E1049091E20497FF03C0909507 |
| :1086A00081959F4F815991404CF01092D2041092C5 |
| :1086B000D1041092D0041092CF04B3CA34E06316F0 |
| :1086C000710449F4A5CA44E06416710421F4A0CAF7 |
| :1086D00081E090E002C080E090E0DF91CF911F91B7 |
| :1086E0000F91FF90EF90DF90CF90BF90AF909F9051 |
| :1086F0008F907F906F905F904F903F902F90089554 |
| :10870000EF92FF920F931F93CF93DF938C01EB01B6 |
| :108710009C0197FF04C022273327281B390BCE0169 |
| :10872000D7FF04C0882799278C1B9D0B82179307BE |
| :108730003CF4CE01E8018C01B1E0EB2EF12C02C03B |
| :10874000EE24FF24209741F40115110529F461E07E |
| :1087500070E080E090E024C0B801882777FD809524 |
| :10876000982F28EE33E040E050E00E9482469E01C0 |
| :10877000442737FD4095542F0E94F646B90137FF34 |
| :1087800003C0709561957F4F882777FD8095982F5E |
| :108790006D3021E0720720E0820720E0920704F5A7 |
| :1087A00024E630E040E050E00E9482462CE031E0D8 |
| :1087B00040E050E00E94F646CA01B901A4E0660F0D |
| :1087C000771F881F991FAA95D1F7621B730B840B23 |
| :1087D000950B24E630E040E050E00E94F64653C09E |
| :1087E000633422E0720720E0820720E0920734F52C |
| :1087F00024E630E040E050E00E948246605B78462C |
| :108800008040904026E331E040E050E00E94F64690 |
| :10881000CA01B901F4E0660F771F881F991FFA9506 |
| :10882000D1F7621B730B840B950B24E630E040E01C |
| :1088300050E00E94F646215F3F4F25C022E330E022 |
| :1088400040E050E00E948246645E70478040904065 |
| :1088500026EA31E040E050E00E94F646CA01B90144 |
| :10886000E4E0660F771F881F991FEA95D1F7621B16 |
| :10887000730B840B950B22E330E040E050E00E9444 |
| :10888000F646225E3F4FEF2829F48AE590E0821BEE |
| :10889000930B9C0117FD03C0D7FF06C002C0D7FD94 |
| :1088A00003C0309521953F4FC901DF91CF911F91B2 |
| :1088B0000F91FF90EF900895FC01F7FF04C0882707 |
| :1088C00099278E1B9F0B8856914034F0CF0168E6A4 |
| :1088D00071E00E94C146FC01F7FD03C041E050E099 |
| :1088E00005C0F095E195FF4F4FEF5FEFCF018B553E |
| :1088F00090408A35910530F484EB90E08E1B9F0BFD |
| :10890000FC010FC0CF01855B90408A35910518F4BA |
| :10891000E45BF0400EC0CF018F5091408A35910545 |
| :1089200018F021E030E007C088E691E08E1B9F0B35 |
| :10893000FC012FEF3FEFEE0FFF1FEF5DFB4F859127 |
| :108940009491BC01629FC001639F900D729F900D36 |
| :1089500011249C01429FC001439F900D529F900D96 |
| :10896000112408952AE530E0281B390BC9010E9423 |
| :108970005C440895EF92FF920F931F93CF93DF9380 |
| :10898000EA01AC0197FF04C044275527481B590B47 |
| :108990009B0177FF04C022273327261B370B2417A0 |
| :1089A000350794F49C01B901882777FD8095982FAD |
| :1089B00028EE33E040E050E00E9482467B018C01CB |
| :1089C000CE010E945C440FC0882777FD8095982FC8 |
| :1089D00028EE33E040E050E00E9482467B018C01AB |
| :1089E000CE010E94B2449C01442737FD4095542F8C |
| :1089F000C801B7010E94F646B90137FF03C0709560 |
| :108A000061957F4F882777FD8095982FDF91CF91D3 |
| :108A10001F910F91FF90EF900895FC01415050403D |
| :108A200030F001900616D1F73197CF0108958827CD |
| :108A3000992708955058192EEFD001D0D2C0BA17F7 |
| :108A40006207730784079507B1F188F40EF4109458 |
| :108A50000B2EBA2FA02D062E622F202D072E732F3E |
| :108A6000302D082E842F402D092E952F502DFF27B5 |
| :108A70005523B9F0591B49F0573E98F04695379564 |
| :108A80002795A795F0405395C9F776F0BA0F621F66 |
| :108A9000731F841F30F4879577956795B795F040DD |
| :108AA000939517FA0F2E0895BF1BBB27BA0B620BC5 |
| :108AB000730B840BF6CFDEF6DBC0AED001D091C0D5 |
| :108AC000552359F0992369F09F575F57951B33F44D |
| :108AD00042F4903811F4915805C09BC091589F3FC3 |
| :108AE00009F4C6C0BB27112462177307840730F44A |
| :108AF000660F771F881FBB1F915098F311D00F92FC |
| :108B00000FD00F920DD0A0E82617370748071B0695 |
| :108B100009F0A048BA2F602D7F918F91002408950D |
| :108B2000A0E80024621773078407B10528F0621BD0 |
| :108B3000730B840BB1090A2A660F771F881FBB1FAE |
| :108B4000A69581F7089597FB73D09F3738F0FEE91B |
| :108B5000F91B982F872F762F6B2F05C086C096950F |
| :108B6000879577956795F150D0F73EF4909580956D |
| :108B7000709561957F4F8F4F9F4F0895E89403C084 |
| :108B800097FB0EF4F3DFB62F672F782F892F9EE91E |
| :108B9000002427C00ED05EF004C00BD026F001C028 |
| :108BA00008D019F020F48FEF089580E0089581E057 |
| :108BB000089597FB092E052600F8689430D0E894B4 |
| :108BC00007FC07C0621773078407950721F008F4B4 |
| :108BD00000940794989408959A95BB0F661F771F89 |
| :108BE000881F11249923A1F08823B2F79F3F59F0E1 |
| :108BF000BB0F48F421F4002011F460FF04C06F5F44 |
| :108C00007F4F8F4F9F4F881F9795879597F90895AE |
| :108C10002CC09FEF80EC0895052E092607FA440F1B |
| :108C2000551F5F3F79F0AA27A51708F051E0479537 |
| :108C3000880F991F9F3F31F0BB27B91708F091E0CB |
| :108C4000879508959F919F911124E3CF97FB880FFB |
| :108C5000991F9F3F31F0BB27B91708F091E0879526 |
| :108C600008959F919F911124D4CF66277727882755 |
| :108C700099270895D1DF01D0B4CF992339F0552336 |
| :108C800029F09F575F57950F13F49AF1F1CF915840 |
| :108C90009F3FE1F3629FA12D0F92BB27639FA00D21 |
| :108CA000B11DEE27729FA00DB11DEE1FAF93AA2735 |
| :108CB000649FB00DE11D739FB00DE11DAA1F6627D3 |
| :108CC000829FB00DE11DA61F5527749FE00DA11DC9 |
| :108CD000551F839FE00DA11D561F849FA00D511DA0 |
| :108CE000852F7A2F6E2F1F900F9088231AF493955B |
| :108CF00039F48FCF000C111CBB1F661F771F881F14 |
| :108D000001280895629FD001739FF001829FE00DBA |
| :108D1000F11D649FE00DF11D929FF00D839FF00DFA |
| :108D2000749FF00D659FF00D9927729FB00DE11DA6 |
| :108D3000F91F639FB00DE11DF91FBD01CF01112483 |
| :108D40000895991B79E004C0991F961708F0961BA7 |
| :108D5000881F7A95C9F780950895AA1BBB1B51E11E |
| :108D600007C0AA1FBB1FA617B70710F0A61BB70B9B |
| :108D7000881F991F5A95A9F780959095BC01CD0140 |
| :108D8000089597FB092E07260AD077FD04D0E5DF6A |
| :108D900006D000201AF4709561957F4F0895F6F77C |
| :108DA000909581959F4F0895A1E21A2EAA1BBB1B97 |
| :108DB000FD010DC0AA1FBB1FEE1FFF1FA217B307A7 |
| :108DC000E407F50720F0A21BB30BE40BF50B661FBD |
| :108DD000771F881F991F1A9469F760957095809581 |
| :108DE00090959B01AC01BD01CF01089597FB092E21 |
| :108DF00005260ED057FD04D0D7DF0AD0001C38F46A |
| :108E000050954095309521953F4F4F4F5F4F0895B6 |
| :108E1000F6F790958095709561957F4F8F4F9F4F96 |
| :108E20000895F999FECFB2BDA1BDF89A119600B48C |
| :108E30000895F999FECFB2BDA1BD00BC11960FB641 |
| :0C8E4000F894FA9AF99A0FBE0895FFCF3B |
| :108E4C000A01FF64496E74656772616C4E69636BED |
| :108E5C0020202020496E74656772616C526F6C6CB7 |
| :108E6C00202020204163634E69636B20202020204A |
| :108E7C0020202020416363526F6C6C202020202026 |
| :108E8C00202020204779726F4769657220202020AE |
| :108E9C0020202020486F6568656E5765727420200D |
| :108EAC00202020204163635A2020202020202020D5 |
| :108EBC0020202020476173202020202020202020EB |
| :108ECC00202020204B6F6D7061737356616C75653B |
| :108EDC002020202045727361747A6B6F6D70617302 |
| :108EEC00732020205573725F506172312020202036 |
| :108EFC00202020205573725F706172332020202057 |
| :108F0C00202020204D6F746F725F566F726E65203B |
| :108F1C00202020204D6F746F725F48696E74656EEF |
| :108F2C00202020204D6F746F725F4C696E6B732024 |
| :108F3C00202020204D6F746F725F526563687473CC |
| :108F4C0020202020496E64657820202020202020BD |
| :108F5C002020202055426174202020202020202019 |
| :108F6C00202020204D657373776572745F4E6963A2 |
| :108F7C006B2020204D657373776572745F526F6C34 |
| :108F8C006C2020204D657373776572745F4769653B |
| :108F9C0072202020537469636B5F4E69636B2020D1 |
| :108FAC0020202020537469636B5F526F6C6C2020FF |
| :108FBC0009200000537469636B5F47696572202058 |
| :108FCC00202020204750535F4E69636B20202020C7 |
| :108FDC00202020204750535F526F6C6C20202020A3 |
| :108FEC002020202075746D5F656173742020202013 |
| :108FFC002020202075746D5F6E6F727468202020A5 |
| :10900C002020202075746D5F616C7420202020203E |
| :10901C00202020206770735F73746174652020209A |
| :10902C00202020204750535F646973745F32747240 |
| :10903C00677420204779726F476965725F436F6D63 |
| :10904C0070202020FFFF0A016400007D0000FF0358 |
| :10905C000102030405060708090A48616C6C6F20BD |
| :10906C0057656C7400000000000000000000000058 |
| :10907C0000000000000000000000000000000000E4 |
| :10908C0000000000000000000000000000000000D4 |
| :10909C0000000000000000000000000000000000C4 |
| :1090AC00000000000000000000000A014265676932 |
| :1090BC006E6E657200004E6F726D616C00005370C5 |
| :1090CC006F72740000640090D0030090D0030017FE |
| :1090DC00B7D13830FB103A409696020A644664ECDD |
| :0290EC00FF0083 |
| :00000001FF |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/GPS.c |
|---|
| 0,0 → 1,644 |
| /* |
| This program (files gps.c and gps.h) is free software; you can redistribute it and/or modify |
| it under the terms of the GNU Lesser General Public License as published by the Free Software Foundation; |
| either version 3 of the License, or (at your option) any later version. |
| This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; |
| without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| GNU General Public License and GNU Lesser General Public License for more details. |
| You should have received a copy of GNU General Public License (License_GPL.txt) and |
| GNU Lesser General Public License (License_LGPL.txt) along with this program. |
| If not, see <http://www.gnu.org/licenses/>. |
| Please note: All the other files for the project "Mikrokopter" by H.Buss are under the license (license_buss.txt) published by www.mikrokopter.de |
| */ |
| /*++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| Peter Muehlenbrock |
| Auswertung der Daten vom GPS im ublox Format |
| Hold Modus mit PID Regler |
| Rückstuerz zur Basis Funktion |
| Stand 24.10.2007 |
| Anederung: 24.10. Altitude in relativer Position jetzt auch drin |
| ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| */ |
| #include "main.h" |
| #include "math.h" |
| //#include "gps.h" |
| // Defines fuer ublox Messageformat um Auswertung zu steuern |
| #define UBLOX_IDLE 0 |
| #define UBLOX_SYNC1 1 |
| #define UBLOX_SYNC2 2 |
| #define UBLOX_CLASS 3 |
| #define UBLOX_ID 4 |
| #define UBLOX_LEN1 5 |
| #define UBLOX_LEN2 6 |
| #define UBLOX_CKA 7 |
| #define UBLOX_CKB 8 |
| #define UBLOX_PAYLOAD 9 |
| // ublox Protokoll Identifier |
| #define UBLOX_NAV_POSUTM 0x08 |
| #define UBLOX_NAV_STATUS 0x03 |
| #define UBLOX_NAV_VELED 0x12 |
| #define UBLOX_NAV_CLASS 0x01 |
| #define UBLOX_SYNCH1_CHAR 0xB5 |
| #define UBLOX_SYNCH2_CHAR 0x62 |
| signed int GPS_Nick = 0; |
| signed int GPS_Roll = 0; |
| short int ublox_msg_state = UBLOX_IDLE; |
| static uint8_t chk_a =0; //Checksum |
| static uint8_t chk_b =0; |
| short int gps_state,gps_sub_state; //Zustaende der Statemachine |
| short int gps_updte_flag; |
| signed int GPS_hdng_abs_2trgt; //Winkel zum Ziel bezogen auf Nordpol |
| signed int GPS_hdng_rel_2trgt; //Winkel zum Ziel bezogen auf Nordachse des Kopters |
| signed int GPS_dist_2trgt; //vorzeichenlose Distanz zum Ziel |
| signed int gps_int_x,gps_int_y,gps_reg_x,gps_reg_y; |
| static unsigned int rx_len; |
| static unsigned int ptr_payload_data_end; |
| unsigned int gps_alive_cnt; // Wird bei jedem gueltigen GPS Telegramm hochgezaehlt |
| signed int hdng_2home,dist_2home; //Richtung und Entfernung zur home Position |
| static signed gps_tick; //wird bei jedem Update durch das GPS Modul hochgezaehlt |
| static short int hold_fast,hold_reset_int; //Flags fuer Hold Regler |
| static uint8_t *ptr_payload_data; |
| static uint8_t *ptr_pac_status; |
| long int dist_flown; |
| short int Get_GPS_data(void); |
| NAV_POSUTM_t actual_pos; // Aktuelle Nav Daten werden hier im ublox Format abgelegt |
| NAV_STATUS_t actual_status; // Aktueller Nav Status |
| NAV_VELNED_t actual_speed; // Aktueller Geschwindigkeits und Richtungsdaten |
| GPS_ABS_POSITION_t gps_act_position; // Alle wichtigen Daten zusammengefasst |
| GPS_ABS_POSITION_t gps_home_position; // Die Startposition, beim Kalibrieren ermittelt |
| GPS_REL_POSITION_t gps_rel_act_position; // Die aktuelle relative Position bezogen auf Home Position |
| GPS_REL_POSITION_t gps_rel_hold_position; // Die gespeicherte Sollposition fuer GPS_ Hold Mode |
| GPS_REL_POSITION_t gps_rel_start_position; // Die gespeicherte Ausgangsposition fuer GPS_ Home Mode |
| // Initialisierung |
| void GPS_Neutral(void) |
| { |
| ublox_msg_state = UBLOX_IDLE; |
| gps_state = GPS_CRTL_IDLE; |
| gps_sub_state = GPS_CRTL_IDLE; |
| actual_pos.status = 0; |
| actual_speed.status = 0; |
| actual_status.status = 0; |
| gps_home_position.status = 0; // Noch keine gueltige Home Position |
| gps_act_position.status = 0; |
| gps_rel_act_position.status = 0; |
| GPS_Nick = 0; |
| GPS_Roll = 0; |
| gps_updte_flag = 0; |
| gps_int_x = 0; |
| gps_int_y = 0; |
| gps_alive_cnt = 0; |
| } |
| // Home Position sichern falls Daten verfuegbar sind. |
| void GPS_Save_Home(void) |
| { |
| short int n; |
| n = Get_GPS_data(); |
| if (n == 0) // Gueltige und aktuelle Daten ? |
| { |
| // Neue GPS Daten liegen vor |
| gps_home_position.utm_east = gps_act_position.utm_east; |
| gps_home_position.utm_north = gps_act_position.utm_north; |
| gps_home_position.utm_alt = gps_act_position.utm_alt; |
| gps_home_position.status = 1; // Home Position gueltig |
| } |
| } |
| // Relative Position zur Home Position bestimmen |
| // Rueckgabewert 0= Daten sind aktuell und gueltig. 1= Keine Aenderung. 2= Daten ungueltig |
| short int Get_Rel_Position(void) |
| { |
| short int n = 0; |
| n = Get_GPS_data(); |
| if (n >=1) return (n); // nix zu tun, weil keine neue Daten da sind |
| if (gps_alive_cnt < 1000) gps_alive_cnt += 600; // Timeoutzaehler. Wird in Motorregler Routine ueberwacht und dekrementiert |
| if (gps_home_position.status > 0) //Nur wenn Home Position vorliegt |
| { |
| gps_rel_act_position.utm_east = (int) (gps_act_position.utm_east - gps_home_position.utm_east); |
| gps_rel_act_position.utm_north = (int) (gps_act_position.utm_north - gps_home_position.utm_north); |
| gps_rel_act_position.utm_alt = (int) (gps_act_position.utm_alt - gps_home_position.utm_alt); |
| gps_rel_act_position.status = 1; // gueltige Positionsdaten |
| n = 0; |
| gps_updte_flag = 1; // zeigt an, dass neue Daten vorliegen. |
| } |
| else |
| { |
| n = 2; //keine gueltigen Daten vorhanden |
| gps_rel_act_position.status = 0; //keine gueltige Position weil keine home Position da ist. |
| } |
| return (n); |
| } |
| // Daten aus aktuellen ublox Messages extrahieren |
| // Rueckgabewert 0= Daten sind aktuell und gueltig. 1= Keine Aenderung. 2= Daten ungueltig |
| short int Get_GPS_data(void) |
| { |
| short int n = 1; |
| if (actual_pos.status == 0) return (1); //damit es schnell geht, wenn nix zu tun ist |
| if ((actual_pos.status > 0) && (actual_status.status > 0) && (actual_speed.status > 0)) |
| { |
| if (((actual_status.gpsfix_type & 0x03) >=2) && ((actual_status.nav_status_flag & 0x01) >=1)) // nur wenn Daten aktuell und gueltig sind |
| { |
| actual_status.status = 0; |
| gps_act_position.utm_east = actual_pos.utm_east/10; |
| gps_act_position.utm_north = actual_pos.utm_north/10; |
| gps_act_position.utm_alt = actual_pos.utm_alt/10; |
| actual_pos.status = 0; //neue ublox Messages anfordern |
| // gps_act_position.speed_gnd = actual_speed.speed_gnd/10; |
| // gps_act_position.speed_gnd = actual_speed.speed_gnd/10; |
| // gps_act_position.heading = actual_speed.heading/100000; |
| actual_speed.status = 0; |
| gps_act_position.status = 1; |
| n = 0; //Daten gueltig |
| } |
| else |
| { |
| gps_act_position.status = 0; //Keine gueltigen Daten |
| actual_speed.status = 0; |
| actual_status.status = 0; |
| actual_pos.status = 0; //neue ublox Messages anfordern |
| n = 2; |
| } |
| } |
| return (n); |
| } |
| /* |
| Daten vom GPS im ublox MSG Format auswerten |
| Die Routine wird bei jedem Empfang eines Zeichens vom GPS Modul durch den UART IRQ aufgerufen |
| // Die UBX Messages NAV_POSUTM, NAV_STATUS und NAV_VALED muessen aktiviert sein |
| */ |
| void Get_Ublox_Msg(uint8_t rx) |
| { |
| switch (ublox_msg_state) |
| { |
| case UBLOX_IDLE: // Zuerst Synchcharacters pruefen |
| if ( rx == UBLOX_SYNCH1_CHAR ) ublox_msg_state = UBLOX_SYNC1; |
| else ublox_msg_state = UBLOX_IDLE; |
| break; |
| case UBLOX_SYNC1: |
| if (rx == UBLOX_SYNCH2_CHAR) ublox_msg_state = UBLOX_SYNC2; |
| else ublox_msg_state = UBLOX_IDLE; |
| chk_a = 0,chk_b = 0; |
| break; |
| case UBLOX_SYNC2: |
| if (rx == UBLOX_NAV_CLASS) ublox_msg_state = UBLOX_CLASS; |
| else ublox_msg_state = UBLOX_IDLE; |
| break; |
| case UBLOX_CLASS: // Nur NAV Meldungen auswerten |
| switch (rx) |
| { |
| case UBLOX_NAV_POSUTM: |
| ptr_pac_status = &actual_pos.status; |
| if (*ptr_pac_status > 0) ublox_msg_state = UBLOX_IDLE; //Abbruch weil Daten noch nicht verwendet wurden |
| else |
| { |
| ptr_payload_data = &actual_pos; |
| ptr_payload_data_end = &actual_pos.status; |
| ublox_msg_state = UBLOX_LEN1; |
| } |
| break; |
| case UBLOX_NAV_STATUS: |
| ptr_pac_status = &actual_status.status; |
| if (*ptr_pac_status > 0) ublox_msg_state = UBLOX_IDLE; |
| else |
| { |
| ptr_payload_data = &actual_status; |
| ptr_payload_data_end = &actual_status.status; |
| ublox_msg_state = UBLOX_LEN1; |
| } |
| break; |
| case UBLOX_NAV_VELED: |
| ptr_pac_status = &actual_speed.status; |
| if (*ptr_pac_status > 0) ublox_msg_state = UBLOX_IDLE; |
| else |
| { |
| ptr_payload_data = &actual_speed; |
| ptr_payload_data_end = &actual_speed.status; |
| ublox_msg_state = UBLOX_LEN1; |
| } |
| break; |
| default: |
| ublox_msg_state = UBLOX_IDLE; |
| break; |
| } |
| chk_a = UBLOX_NAV_CLASS + rx; |
| chk_b = UBLOX_NAV_CLASS + chk_a; |
| break; |
| case UBLOX_LEN1: // Laenge auswerten |
| rx_len = rx; |
| chk_a += rx; |
| chk_b += chk_a; |
| ublox_msg_state = UBLOX_LEN2; |
| break; |
| case UBLOX_LEN2: // Laenge auswerten |
| rx_len = rx_len + (rx *256); // Laenge ermitteln |
| chk_a += rx; |
| chk_b += chk_a; |
| ublox_msg_state = UBLOX_PAYLOAD; |
| break; |
| case UBLOX_PAYLOAD: // jetzt Nutzdaten einlesen |
| if (rx_len > 0) |
| { |
| *ptr_payload_data = rx; |
| chk_a += rx; |
| chk_b += chk_a; |
| --rx_len; |
| if ((rx_len > 0) && (ptr_payload_data <= ptr_payload_data_end)) |
| { |
| ptr_payload_data++; |
| ublox_msg_state = UBLOX_PAYLOAD; |
| } |
| else ublox_msg_state = UBLOX_CKA; |
| } |
| else ublox_msg_state = UBLOX_IDLE; // Abbruch wegen Fehler |
| break; |
| case UBLOX_CKA: // Checksum pruefen |
| if (rx == chk_a) ublox_msg_state = UBLOX_CKB; |
| else ublox_msg_state = UBLOX_IDLE; // Abbruch wegen Fehler |
| break; |
| case UBLOX_CKB: // Checksum pruefen |
| if (rx == chk_b) *ptr_pac_status = 1; // Paket ok |
| ublox_msg_state = UBLOX_IDLE; |
| break; |
| default: |
| ublox_msg_state = UBLOX_IDLE; |
| break; |
| } |
| } |
| //Zentrale Statemachine fuer alle GPS relevanten Regelungsablauefe |
| short int GPS_CRTL(short int cmd) |
| { |
| static unsigned int cnt; //Zaehler fuer diverse Verzoegerungen |
| static signed int int_east,int_north; //Integrierer |
| static signed int dist_north,dist_east; |
| static signed int diff_east,diff_north; // Differenzierer (Differenz zum vorhergehenden x bzw. y Wert) |
| static signed int diff_east_f,diff_north_f; // Differenzierer, gefiltert |
| signed int n,diff_v; |
| static signed int gps_g2t_act_v; // Aktuelle Geschwindigkeitsvorgabe fuer Home Funktion |
| long signed int dev,n_l; |
| signed int dist_frm_start_east,dist_frm_start_north; |
| switch (cmd) |
| { |
| case GPS_CMD_REQ_HOME: // Es soll zum Startpunkt zurueckgeflogen werden. |
| if ((gps_state != GPS_CRTL_HOLD_ACTIVE) && (gps_state != GPS_CRTL_HOME_ACTIVE)) |
| { |
| cnt++; |
| if (cnt > 400) // erst nach Verzoegerung |
| { |
| // Erst mal initialisieren |
| cnt = 0; |
| gps_tick = 0; |
| hold_fast = 0; |
| hold_reset_int = 0; // Integrator enablen |
| int_east = 0, int_north = 0; |
| gps_reg_x = 0, gps_reg_y = 0; |
| dist_east = 0, dist_north = 0; |
| diff_east_f = 0, diff_north_f= 0; |
| diff_east = 0, diff_north = 0; |
| dist_flown = 0; |
| gps_g2t_act_v = 0; |
| gps_sub_state = GPS_CRTL_IDLE; |
| // aktuelle positionsdaten abspeichern |
| if (gps_rel_act_position.status > 0) |
| { |
| gps_rel_start_position.utm_east = gps_rel_act_position.utm_east; |
| gps_rel_start_position.utm_north= gps_rel_act_position.utm_north; |
| gps_rel_start_position.status = 1; // gueltige Positionsdaten |
| gps_rel_hold_position.utm_east = gps_rel_act_position.utm_east; |
| gps_rel_hold_position.utm_north = gps_rel_act_position.utm_north; |
| gps_rel_hold_position.status = 1; // gueltige Positionsdaten |
| //Richtung zur Home Position bezogen auf Nordpol bestimmen |
| hdng_2home = arctan_i(-gps_rel_start_position.utm_east,-gps_rel_start_position.utm_north); |
| // in Winkel 0...360 Grad umrechnen |
| if (( gps_rel_start_position.utm_east < 0)) hdng_2home = ( 90-hdng_2home); |
| else hdng_2home = (270 - hdng_2home); |
| dist_2home = (int) get_dist(gps_rel_start_position.utm_east,gps_rel_start_position.utm_north,hdng_2home); //Entfernung zur Home Position bestimmen |
| gps_state = GPS_CRTL_HOME_ACTIVE; |
| return (GPS_STST_OK); |
| } |
| else |
| { |
| gps_rel_start_position.status = 0; //Keine Daten verfuegbar |
| gps_state = GPS_CRTL_IDLE; |
| return(GPS_STST_ERR); // Keine Daten da |
| } |
| } |
| else return(GPS_STST_PEND); // noch warten |
| } |
| break; |
| // ****************************** |
| case GPS_CMD_REQ_HOLD: // Die Lageregelung soll aktiviert werden. |
| if (gps_state != GPS_CRTL_HOLD_ACTIVE) |
| { |
| cnt++; |
| if (cnt > 400) // erst nach Verzoegerung |
| { |
| cnt = 0; |
| // aktuelle positionsdaten abspeichern |
| if (gps_rel_act_position.status > 0) |
| { |
| hold_fast = 0; |
| hold_reset_int = 0; // Integrator enablen |
| int_east = 0, int_north = 0; |
| gps_reg_x = 0, gps_reg_y = 0; |
| dist_east = 0, dist_north = 0; |
| diff_east_f = 0, diff_north_f= 0; |
| diff_east = 0, diff_north = 0; |
| gps_rel_hold_position.utm_east = gps_rel_act_position.utm_east; |
| gps_rel_hold_position.utm_north = gps_rel_act_position.utm_north; |
| gps_rel_hold_position.status = 1; // gueltige Positionsdaten |
| gps_state = GPS_CRTL_HOLD_ACTIVE; |
| return (GPS_STST_OK); |
| } |
| else |
| { |
| gps_rel_hold_position.status = 0; //Keine Daten verfuegbar |
| gps_state = GPS_CRTL_IDLE; |
| return(GPS_STST_ERR); // Keine Daten da |
| } |
| } |
| else return(GPS_STST_PEND); // noch warten |
| } |
| break; |
| case GPS_CMD_STOP: // Lageregelung beenden |
| cnt = 0; |
| GPS_Nick = 0; |
| GPS_Roll = 0; |
| gps_int_x = 0; |
| gps_int_y = 0; |
| gps_sub_state = GPS_CRTL_IDLE; |
| gps_state = GPS_CRTL_IDLE; |
| return (GPS_STST_OK); |
| break; |
| default: |
| return (GPS_STST_ERR); |
| break; |
| } |
| switch (gps_state) |
| { |
| case GPS_CRTL_IDLE: |
| cnt = 0; |
| return (GPS_STST_OK); |
| break; |
| case GPS_CRTL_HOME_ACTIVE: // Rueckflug zur Basis |
| //Der Sollwert des Lagereglers wird der Homeposition angenaehert |
| if (gps_rel_start_position.status >0) |
| { |
| if ((gps_updte_flag > 0) && (gps_sub_state !=GPS_HOME_FINISHED)) // nur wenn neue GPS Daten vorliegen und nicht schon alles fertig ist |
| { |
| gps_tick++; |
| int d1,d2,d3; |
| d1 = abs (gps_rel_hold_position.utm_east - gps_rel_act_position.utm_east ); |
| d2 = abs (gps_rel_hold_position.utm_north - gps_rel_act_position.utm_north ); |
| d3 = (dist_2home - (int)dist_flown); // Restdistanz zum Ziel |
| if (d3 > GPS_G2T_DIST_MAX_STOP) // Schneller Rueckflug, noch weit weg vom Ziel |
| { |
| if ((d1 < GPS_G2T_FAST_TOL) && (d2 < GPS_G2T_FAST_TOL)) //nur weiter wenn Lage innerhalb der Toleranz |
| { |
| if (gps_g2t_act_v < GPS_G2T_V_MAX) gps_g2t_act_v++; //Geschwindigkeit langsam erhoehen |
| dist_flown +=(long)gps_g2t_act_v; // Vorgabe der Strecke anhand der Geschwindigkeit |
| gps_sub_state = GPS_HOME_FAST_IN_TOL; |
| } |
| else //Den Lageregler in Ruhe arbeiten lassen weil ausserhalb der Toleranz |
| { |
| if (gps_g2t_act_v > 1) gps_g2t_act_v--; // Geschwindigkeit reduzieren |
| dist_flown++; //Auch ausserhalb der Toleranz langsam erhoehen |
| gps_sub_state = GPS_HOME_FAST_OUTOF_TOL; |
| } |
| hold_reset_int = 0; // Integrator einsschalten |
| hold_fast = 1; // Regler fuer schnellen Flug |
| dist_frm_start_east = (int)((dist_flown * (long)sin_i(hdng_2home))/1000); |
| dist_frm_start_north = (int)((dist_flown * (long)cos_i(hdng_2home))/1000); |
| gps_rel_hold_position.utm_east = gps_rel_start_position.utm_east + dist_frm_start_east; //naechster Zielpunkt |
| gps_rel_hold_position.utm_north = gps_rel_start_position.utm_north + dist_frm_start_north; //naechster Zielpunkt |
| } |
| else if (d3 > GPS_G2T_DIST_HOLD) //Das Ziel naehert sich, deswegen abbremsen |
| { |
| if ((d1 < GPS_G2T_NRML_TOL) && (d2 < GPS_G2T_NRML_TOL)) |
| { |
| dist_flown += GPS_G2T_V_RAMP_DWN; // Vorgabe der Strecke anhand der Geschwindigkeit |
| gps_sub_state = GPS_HOME_RMPDWN_IN_TOL; |
| } |
| else |
| { |
| dist_flown++; //Auch ausserhalb der Toleranz langsam erhoehen |
| gps_sub_state = GPS_HOME_RMPDWN_OUTOF_TOL; |
| } |
| hold_reset_int = 0; // Integrator ausschalten |
| hold_fast = 1; // Wieder normal regeln |
| dist_frm_start_east = (int)((dist_flown * (long)sin_i(hdng_2home))/1000); |
| dist_frm_start_north = (int)((dist_flown * (long)cos_i(hdng_2home))/1000); |
| gps_rel_hold_position.utm_east = gps_rel_start_position.utm_east + dist_frm_start_east; //naechster Zielpunkt |
| gps_rel_hold_position.utm_north = gps_rel_start_position.utm_north + dist_frm_start_north; //naechster Zielpunkt |
| } |
| else //Soll-Ziel fast erreicht, Jetzt noch Reste ausgleichen, weil Zielpunkt nicht exakt bestimmt werden konnte (Fehler in Winkelfkt) |
| { |
| if ((d1 < GPS_G2T_NRML_TOL) && (d2 < GPS_G2T_NRML_TOL)) // Jetzt bis zum Zielpunkt regeln |
| { |
| gps_sub_state = GPS_HOME_IN_TOL; |
| hold_fast = 0; // Wieder normal regeln |
| hold_reset_int = 0; // Integrator wieder aktivieren |
| if (gps_rel_hold_position.utm_east >= GPS_G2T_V_MIN) gps_rel_hold_position.utm_east -= GPS_G2T_V_MIN; |
| else if (gps_rel_hold_position.utm_east <= -GPS_G2T_V_MIN ) gps_rel_hold_position.utm_east += GPS_G2T_V_MIN; |
| if (gps_rel_hold_position.utm_north >= GPS_G2T_V_MIN) gps_rel_hold_position.utm_north -= GPS_G2T_V_MIN; |
| else if (gps_rel_hold_position.utm_north <= - GPS_G2T_V_MIN ) gps_rel_hold_position.utm_north += GPS_G2T_V_MIN; |
| if ((abs(gps_rel_hold_position.utm_east) <= GPS_G2T_V_MIN) && (abs(gps_rel_hold_position.utm_north) <=GPS_G2T_V_MIN)) |
| { |
| gps_rel_hold_position.utm_east = 0; |
| gps_rel_hold_position.utm_north = 0; |
| gps_sub_state = GPS_HOME_FINISHED; |
| } |
| } |
| else gps_sub_state = GPS_HOME_OUTOF_TOL; |
| } |
| } |
| gps_state = GPS_CRTL_HOLD_ACTIVE; //Zwischensprung |
| return (GPS_STST_OK); |
| } |
| else // Keine GPS Daten verfuegbar, deswegen Abbruch |
| { |
| gps_state = GPS_CRTL_IDLE; |
| return (GPS_STST_ERR); |
| } |
| break; |
| case GPS_CRTL_HOLD_ACTIVE: // Hier werden die Daten fuer Nick und Roll errechnet |
| if (gps_updte_flag >0) // nur wenn neue GPS Daten vorliegen |
| { |
| gps_updte_flag = 0; |
| // ab hier wird geregelt |
| diff_east = -dist_east; //Alten Wert fuer Differenzier schon mal abziehen |
| diff_north = -dist_north; |
| dist_east = gps_rel_hold_position.utm_east - gps_rel_act_position.utm_east; |
| dist_north = gps_rel_hold_position.utm_north - gps_rel_act_position.utm_north; |
| int_east += dist_east; |
| int_north += dist_north; |
| diff_east += dist_east; // Differenz zur vorhergehenden East Position |
| diff_north += dist_north; // Differenz zur vorhergehenden North Position |
| if (hold_fast > 0) // wegen Sollpositionsspruengen im Fast Mode Differenzierer daempfen |
| { |
| diff_east_f = ((diff_east_f *2)/3) + (diff_east *1/3); //Differenzierer filtern |
| diff_north_f = ((diff_north_f *2)/3) + (diff_north*1/3); //Differenzierer filtern |
| } |
| else // schwache Filterung |
| { |
| diff_east_f = ((diff_east_f * 1)/4) + ((diff_east *3)/4); //Differenzierer filtern |
| diff_north_f = ((diff_north_f * 1)/4) + ((diff_north*3)/4); //Differenzierer filtern |
| } |
| #define GPSINT_MAX 30000 //neuer Wert ab 7.10.2007 Begrenzung |
| if ((abs(int_east) > GPSINT_MAX) || (abs(int_north)> GPSINT_MAX)) //Bei zu hohem Wert Integrator auf Wert halten |
| { |
| int_east -= dist_east; |
| int_north -= dist_north; |
| } |
| if (hold_reset_int > 0) //Im Schnellen Mode Integrator abschalten |
| { |
| int_east = 0; |
| int_north = 0; |
| } |
| // Variable Verstarkung fuer Differenzierer ermitteln. Je weiter vom Ziel wir entfernt sind |
| // desto groesser wird der Faktor. Es gibt aber einen Maximalwert. Bei 0 ist die Verstaerkung immer 1 |
| signed long dist,int_east1,int_north1; |
| int phi; |
| phi = arctan_i(abs(dist_north),abs(dist_east)); |
| dist = get_dist(dist_east,dist_north,phi); //Zunaechst Entfernung zum Ziel ermitteln |
| if (hold_fast == 0) // je Nach Modus andere Verstaerkungskurve fuer Differenzierer |
| { |
| diff_v = (int)((dist * (GPS_DIFF_NRML_MAX_V - 10)) / GPS_DIFF_NRML_MAX_D) +10; //Verstaerkung * 10 |
| if (diff_v > GPS_DIFF_NRML_MAX_V) diff_v = GPS_DIFF_NRML_MAX_V; //begrenzen |
| } |
| else |
| { |
| diff_v = (int)((dist * (GPS_DIFF_FAST_MAX_V - 10)) / GPS_DIFF_FAST_MAX_D) +10; //Verstaerkung * 10 |
| if (diff_v > GPS_DIFF_FAST_MAX_V) diff_v = GPS_DIFF_FAST_MAX_V; //begrenzen |
| } |
| int diff_p; //Vom Modus abhaengige zusaetzliche Verstaerkung |
| if (hold_fast > 0) diff_p = GPS_PROP_FAST_V; |
| else diff_p = GPS_PROP_NRML_V; |
| //I Werte begrenzen |
| #define INT1_MAX (20 * GPS_V) |
| int_east1 = ((((long)int_east) * Parameter_UserParam2)/32)/GPS_USR_PAR_FKT; |
| int_north1 = ((((long)int_north) * Parameter_UserParam2)/32)/GPS_USR_PAR_FKT; //Fehler behoben am 17.12.2007 vorher int_north= |
| if (int_east1 > INT1_MAX) int_east1 = INT1_MAX; //begrenzen |
| else if (int_east1 < -INT1_MAX) int_east1 = -INT1_MAX; |
| if (int_north1 > INT1_MAX) int_north1 = INT1_MAX; //begrenzen |
| else if (int_north1 < -INT1_MAX) int_north1 = -INT1_MAX; |
| //PID Regler Werte aufsummieren |
| gps_reg_x = ((int)int_east1 + ((dist_east * (Parameter_UserParam1/GPS_USR_PAR_FKT) * diff_p)/(8*2))+ ((diff_east_f * diff_v * (Parameter_UserParam3/GPS_USR_PAR_FKT))/10)); // I + P +D Anteil X Achse |
| gps_reg_y = ((int)int_north1 + ((dist_north * (Parameter_UserParam1/GPS_USR_PAR_FKT) * diff_p)/(8*2))+ ((diff_north_f * diff_v * (Parameter_UserParam3/GPS_USR_PAR_FKT))/10)); // I + P +D Anteil Y Achse |
| //Ziel-Richtung bezogen auf Nordpol bestimmen |
| GPS_hdng_abs_2trgt = arctan_i(gps_reg_x,gps_reg_y); |
| // in Winkel 0...360 Grad umrechnen |
| if ((gps_reg_x >= 0)) GPS_hdng_abs_2trgt = ( 90-GPS_hdng_abs_2trgt); |
| else GPS_hdng_abs_2trgt = (270 - GPS_hdng_abs_2trgt); |
| // Relative Richtung in bezug auf Nordachse des Kopters errechen |
| n= GyroKomp_Int/GYROKOMP_INC_GRAD_DEFAULT; |
| GPS_hdng_rel_2trgt = GPS_hdng_abs_2trgt - n; |
| if ((GPS_hdng_rel_2trgt >180) && (GPS_hdng_abs_2trgt >=180)) GPS_hdng_rel_2trgt = GPS_hdng_rel_2trgt-360; |
| else if (GPS_hdng_rel_2trgt >180) GPS_hdng_rel_2trgt = 360 - GPS_hdng_rel_2trgt; |
| else if (GPS_hdng_rel_2trgt <-180) GPS_hdng_rel_2trgt = 360 + GPS_hdng_rel_2trgt; |
| // Regelabweichung aus x,y zu Ziel in Distanz umrechnen |
| if (abs(gps_reg_x) > abs(gps_reg_y) ) |
| { |
| dev = (long)gps_reg_x; //Groesseren Wert wegen besserer Genauigkeit nehmen |
| dev = abs((dev *1000) / (long) sin_i(GPS_hdng_abs_2trgt)); |
| } |
| else |
| { |
| dev = (long)gps_reg_y; |
| dev = abs((dev *1000) / (long) cos_i(GPS_hdng_abs_2trgt)); |
| } |
| GPS_dist_2trgt = (int) dev; |
| // Winkel und Distanz in Nick und Rollgroessen umrechnen |
| GPS_Roll = (int) +( (dev * (long) sin_i(GPS_hdng_rel_2trgt))/1000); |
| GPS_Nick = (int) -( (dev * (long) cos_i(GPS_hdng_rel_2trgt))/1000); |
| if (GPS_Roll > (GPS_NICKROLL_MAX * GPS_V)) GPS_Roll = (GPS_NICKROLL_MAX * GPS_V); |
| else if (GPS_Roll < -(GPS_NICKROLL_MAX * GPS_V)) GPS_Roll = -(GPS_NICKROLL_MAX * GPS_V); |
| if (GPS_Nick > (GPS_NICKROLL_MAX * GPS_V)) GPS_Nick = (GPS_NICKROLL_MAX * GPS_V); |
| else if (GPS_Nick < -(GPS_NICKROLL_MAX * GPS_V)) GPS_Nick = -(GPS_NICKROLL_MAX * GPS_V); |
| //Kleine Werte verstaerken, Grosse abschwaechen |
| n = sin_i((GPS_Roll*90)/(GPS_NICKROLL_MAX * GPS_V)); |
| n_l = ((long) GPS_NICKROLL_MAX * (long) n)/1000; |
| GPS_Roll = (int) n_l; |
| n = sin_i((GPS_Nick*90)/(GPS_NICKROLL_MAX * GPS_V)); |
| n_l = ((long) GPS_NICKROLL_MAX * (long) n)/1000; |
| GPS_Nick = (int) n_l; |
| if ((abs(dist_east) > GPS_DIST_MAX) || (abs(dist_north) > GPS_DIST_MAX)) // bei zu grossem Abstand abbrechen |
| { |
| GPS_Roll = 0; |
| GPS_Nick = 0; |
| gps_state = GPS_CRTL_IDLE; |
| return (GPS_STST_ERR); |
| break; |
| } |
| else |
| { |
| if ( cmd == GPS_CMD_REQ_HOME ) gps_state = GPS_CRTL_HOME_ACTIVE; // State umsetzen |
| return (GPS_STST_OK); |
| } |
| } |
| else |
| { |
| if ( cmd == GPS_CMD_REQ_HOME ) gps_state = GPS_CRTL_HOME_ACTIVE; // State umsetzen |
| return (GPS_STST_OK); |
| } |
| break; |
| default: |
| gps_state = GPS_CRTL_IDLE; |
| return (GPS_STST_ERR); |
| break; |
| } |
| return (GPS_STST_ERR); |
| } |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/License_GPL.txt |
|---|
| 0,0 → 1,674 |
| GNU GENERAL PUBLIC LICENSE |
| Version 3, 29 June 2007 |
| Copyright (C) 2007 Free Software Foundation, Inc. <http://fsf.org/> |
| Everyone is permitted to copy and distribute verbatim copies |
| of this license document, but changing it is not allowed. |
| Preamble |
| The GNU General Public License is a free, copyleft license for |
| software and other kinds of works. |
| The licenses for most software and other practical works are designed |
| to take away your freedom to share and change the works. By contrast, |
| the GNU General Public License is intended to guarantee your freedom to |
| share and change all versions of a program--to make sure it remains free |
| software for all its users. We, the Free Software Foundation, use the |
| GNU General Public License for most of our software; it applies also to |
| any other work released this way by its authors. You can apply it to |
| your programs, too. |
| When we speak of free software, we are referring to freedom, not |
| price. Our General Public Licenses are designed to make sure that you |
| have the freedom to distribute copies of free software (and charge for |
| them if you wish), that you receive source code or can get it if you |
| want it, that you can change the software or use pieces of it in new |
| free programs, and that you know you can do these things. |
| To protect your rights, we need to prevent others from denying you |
| these rights or asking you to surrender the rights. Therefore, you have |
| certain responsibilities if you distribute copies of the software, or if |
| you modify it: responsibilities to respect the freedom of others. |
| For example, if you distribute copies of such a program, whether |
| gratis or for a fee, you must pass on to the recipients the same |
| freedoms that you received. You must make sure that they, too, receive |
| or can get the source code. And you must show them these terms so they |
| know their rights. |
| Developers that use the GNU GPL protect your rights with two steps: |
| (1) assert copyright on the software, and (2) offer you this License |
| giving you legal permission to copy, distribute and/or modify it. |
| For the developers' and authors' protection, the GPL clearly explains |
| that there is no warranty for this free software. For both users' and |
| authors' sake, the GPL requires that modified versions be marked as |
| changed, so that their problems will not be attributed erroneously to |
| authors of previous versions. |
| Some devices are designed to deny users access to install or run |
| modified versions of the software inside them, although the manufacturer |
| can do so. This is fundamentally incompatible with the aim of |
| protecting users' freedom to change the software. The systematic |
| pattern of such abuse occurs in the area of products for individuals to |
| use, which is precisely where it is most unacceptable. Therefore, we |
| have designed this version of the GPL to prohibit the practice for those |
| products. If such problems arise substantially in other domains, we |
| stand ready to extend this provision to those domains in future versions |
| of the GPL, as needed to protect the freedom of users. |
| Finally, every program is threatened constantly by software patents. |
| States should not allow patents to restrict development and use of |
| software on general-purpose computers, but in those that do, we wish to |
| avoid the special danger that patents applied to a free program could |
| make it effectively proprietary. To prevent this, the GPL assures that |
| patents cannot be used to render the program non-free. |
| The precise terms and conditions for copying, distribution and |
| modification follow. |
| TERMS AND CONDITIONS |
| 0. Definitions. |
| "This License" refers to version 3 of the GNU General Public License. |
| "Copyright" also means copyright-like laws that apply to other kinds of |
| works, such as semiconductor masks. |
| "The Program" refers to any copyrightable work licensed under this |
| License. Each licensee is addressed as "you". "Licensees" and |
| "recipients" may be individuals or organizations. |
| To "modify" a work means to copy from or adapt all or part of the work |
| in a fashion requiring copyright permission, other than the making of an |
| exact copy. The resulting work is called a "modified version" of the |
| earlier work or a work "based on" the earlier work. |
| A "covered work" means either the unmodified Program or a work based |
| on the Program. |
| To "propagate" a work means to do anything with it that, without |
| permission, would make you directly or secondarily liable for |
| infringement under applicable copyright law, except executing it on a |
| computer or modifying a private copy. Propagation includes copying, |
| distribution (with or without modification), making available to the |
| public, and in some countries other activities as well. |
| To "convey" a work means any kind of propagation that enables other |
| parties to make or receive copies. Mere interaction with a user through |
| a computer network, with no transfer of a copy, is not conveying. |
| An interactive user interface displays "Appropriate Legal Notices" |
| to the extent that it includes a convenient and prominently visible |
| feature that (1) displays an appropriate copyright notice, and (2) |
| tells the user that there is no warranty for the work (except to the |
| extent that warranties are provided), that licensees may convey the |
| work under this License, and how to view a copy of this License. If |
| the interface presents a list of user commands or options, such as a |
| menu, a prominent item in the list meets this criterion. |
| 1. Source Code. |
| The "source code" for a work means the preferred form of the work |
| for making modifications to it. "Object code" means any non-source |
| form of a work. |
| A "Standard Interface" means an interface that either is an official |
| standard defined by a recognized standards body, or, in the case of |
| interfaces specified for a particular programming language, one that |
| is widely used among developers working in that language. |
| The "System Libraries" of an executable work include anything, other |
| than the work as a whole, that (a) is included in the normal form of |
| packaging a Major Component, but which is not part of that Major |
| Component, and (b) serves only to enable use of the work with that |
| Major Component, or to implement a Standard Interface for which an |
| implementation is available to the public in source code form. A |
| "Major Component", in this context, means a major essential component |
| (kernel, window system, and so on) of the specific operating system |
| (if any) on which the executable work runs, or a compiler used to |
| produce the work, or an object code interpreter used to run it. |
| The "Corresponding Source" for a work in object code form means all |
| the source code needed to generate, install, and (for an executable |
| work) run the object code and to modify the work, including scripts to |
| control those activities. However, it does not include the work's |
| System Libraries, or general-purpose tools or generally available free |
| programs which are used unmodified in performing those activities but |
| which are not part of the work. For example, Corresponding Source |
| includes interface definition files associated with source files for |
| the work, and the source code for shared libraries and dynamically |
| linked subprograms that the work is specifically designed to require, |
| such as by intimate data communication or control flow between those |
| subprograms and other parts of the work. |
| The Corresponding Source need not include anything that users |
| can regenerate automatically from other parts of the Corresponding |
| Source. |
| The Corresponding Source for a work in source code form is that |
| same work. |
| 2. Basic Permissions. |
| All rights granted under this License are granted for the term of |
| copyright on the Program, and are irrevocable provided the stated |
| conditions are met. This License explicitly affirms your unlimited |
| permission to run the unmodified Program. The output from running a |
| covered work is covered by this License only if the output, given its |
| content, constitutes a covered work. This License acknowledges your |
| rights of fair use or other equivalent, as provided by copyright law. |
| You may make, run and propagate covered works that you do not |
| convey, without conditions so long as your license otherwise remains |
| in force. You may convey covered works to others for the sole purpose |
| of having them make modifications exclusively for you, or provide you |
| with facilities for running those works, provided that you comply with |
| the terms of this License in conveying all material for which you do |
| not control copyright. Those thus making or running the covered works |
| for you must do so exclusively on your behalf, under your direction |
| and control, on terms that prohibit them from making any copies of |
| your copyrighted material outside their relationship with you. |
| Conveying under any other circumstances is permitted solely under |
| the conditions stated below. Sublicensing is not allowed; section 10 |
| makes it unnecessary. |
| 3. Protecting Users' Legal Rights From Anti-Circumvention Law. |
| No covered work shall be deemed part of an effective technological |
| measure under any applicable law fulfilling obligations under article |
| 11 of the WIPO copyright treaty adopted on 20 December 1996, or |
| similar laws prohibiting or restricting circumvention of such |
| measures. |
| When you convey a covered work, you waive any legal power to forbid |
| circumvention of technological measures to the extent such circumvention |
| is effected by exercising rights under this License with respect to |
| the covered work, and you disclaim any intention to limit operation or |
| modification of the work as a means of enforcing, against the work's |
| users, your or third parties' legal rights to forbid circumvention of |
| technological measures. |
| 4. Conveying Verbatim Copies. |
| You may convey verbatim copies of the Program's source code as you |
| receive it, in any medium, provided that you conspicuously and |
| appropriately publish on each copy an appropriate copyright notice; |
| keep intact all notices stating that this License and any |
| non-permissive terms added in accord with section 7 apply to the code; |
| keep intact all notices of the absence of any warranty; and give all |
| recipients a copy of this License along with the Program. |
| You may charge any price or no price for each copy that you convey, |
| and you may offer support or warranty protection for a fee. |
| 5. Conveying Modified Source Versions. |
| You may convey a work based on the Program, or the modifications to |
| produce it from the Program, in the form of source code under the |
| terms of section 4, provided that you also meet all of these conditions: |
| a) The work must carry prominent notices stating that you modified |
| it, and giving a relevant date. |
| b) The work must carry prominent notices stating that it is |
| released under this License and any conditions added under section |
| 7. This requirement modifies the requirement in section 4 to |
| "keep intact all notices". |
| c) You must license the entire work, as a whole, under this |
| License to anyone who comes into possession of a copy. This |
| License will therefore apply, along with any applicable section 7 |
| additional terms, to the whole of the work, and all its parts, |
| regardless of how they are packaged. This License gives no |
| permission to license the work in any other way, but it does not |
| invalidate such permission if you have separately received it. |
| d) If the work has interactive user interfaces, each must display |
| Appropriate Legal Notices; however, if the Program has interactive |
| interfaces that do not display Appropriate Legal Notices, your |
| work need not make them do so. |
| A compilation of a covered work with other separate and independent |
| works, which are not by their nature extensions of the covered work, |
| and which are not combined with it such as to form a larger program, |
| in or on a volume of a storage or distribution medium, is called an |
| "aggregate" if the compilation and its resulting copyright are not |
| used to limit the access or legal rights of the compilation's users |
| beyond what the individual works permit. Inclusion of a covered work |
| in an aggregate does not cause this License to apply to the other |
| parts of the aggregate. |
| 6. Conveying Non-Source Forms. |
| You may convey a covered work in object code form under the terms |
| of sections 4 and 5, provided that you also convey the |
| machine-readable Corresponding Source under the terms of this License, |
| in one of these ways: |
| a) Convey the object code in, or embodied in, a physical product |
| (including a physical distribution medium), accompanied by the |
| Corresponding Source fixed on a durable physical medium |
| customarily used for software interchange. |
| b) Convey the object code in, or embodied in, a physical product |
| (including a physical distribution medium), accompanied by a |
| written offer, valid for at least three years and valid for as |
| long as you offer spare parts or customer support for that product |
| model, to give anyone who possesses the object code either (1) a |
| copy of the Corresponding Source for all the software in the |
| product that is covered by this License, on a durable physical |
| medium customarily used for software interchange, for a price no |
| more than your reasonable cost of physically performing this |
| conveying of source, or (2) access to copy the |
| Corresponding Source from a network server at no charge. |
| c) Convey individual copies of the object code with a copy of the |
| written offer to provide the Corresponding Source. This |
| alternative is allowed only occasionally and noncommercially, and |
| only if you received the object code with such an offer, in accord |
| with subsection 6b. |
| d) Convey the object code by offering access from a designated |
| place (gratis or for a charge), and offer equivalent access to the |
| Corresponding Source in the same way through the same place at no |
| further charge. You need not require recipients to copy the |
| Corresponding Source along with the object code. If the place to |
| copy the object code is a network server, the Corresponding Source |
| may be on a different server (operated by you or a third party) |
| that supports equivalent copying facilities, provided you maintain |
| clear directions next to the object code saying where to find the |
| Corresponding Source. Regardless of what server hosts the |
| Corresponding Source, you remain obligated to ensure that it is |
| available for as long as needed to satisfy these requirements. |
| e) Convey the object code using peer-to-peer transmission, provided |
| you inform other peers where the object code and Corresponding |
| Source of the work are being offered to the general public at no |
| charge under subsection 6d. |
| A separable portion of the object code, whose source code is excluded |
| from the Corresponding Source as a System Library, need not be |
| included in conveying the object code work. |
| A "User Product" is either (1) a "consumer product", which means any |
| tangible personal property which is normally used for personal, family, |
| or household purposes, or (2) anything designed or sold for incorporation |
| into a dwelling. In determining whether a product is a consumer product, |
| doubtful cases shall be resolved in favor of coverage. For a particular |
| product received by a particular user, "normally used" refers to a |
| typical or common use of that class of product, regardless of the status |
| of the particular user or of the way in which the particular user |
| actually uses, or expects or is expected to use, the product. A product |
| is a consumer product regardless of whether the product has substantial |
| commercial, industrial or non-consumer uses, unless such uses represent |
| the only significant mode of use of the product. |
| "Installation Information" for a User Product means any methods, |
| procedures, authorization keys, or other information required to install |
| and execute modified versions of a covered work in that User Product from |
| a modified version of its Corresponding Source. The information must |
| suffice to ensure that the continued functioning of the modified object |
| code is in no case prevented or interfered with solely because |
| modification has been made. |
| If you convey an object code work under this section in, or with, or |
| specifically for use in, a User Product, and the conveying occurs as |
| part of a transaction in which the right of possession and use of the |
| User Product is transferred to the recipient in perpetuity or for a |
| fixed term (regardless of how the transaction is characterized), the |
| Corresponding Source conveyed under this section must be accompanied |
| by the Installation Information. But this requirement does not apply |
| if neither you nor any third party retains the ability to install |
| modified object code on the User Product (for example, the work has |
| been installed in ROM). |
| The requirement to provide Installation Information does not include a |
| requirement to continue to provide support service, warranty, or updates |
| for a work that has been modified or installed by the recipient, or for |
| the User Product in which it has been modified or installed. Access to a |
| network may be denied when the modification itself materially and |
| adversely affects the operation of the network or violates the rules and |
| protocols for communication across the network. |
| Corresponding Source conveyed, and Installation Information provided, |
| in accord with this section must be in a format that is publicly |
| documented (and with an implementation available to the public in |
| source code form), and must require no special password or key for |
| unpacking, reading or copying. |
| 7. Additional Terms. |
| "Additional permissions" are terms that supplement the terms of this |
| License by making exceptions from one or more of its conditions. |
| Additional permissions that are applicable to the entire Program shall |
| be treated as though they were included in this License, to the extent |
| that they are valid under applicable law. If additional permissions |
| apply only to part of the Program, that part may be used separately |
| under those permissions, but the entire Program remains governed by |
| this License without regard to the additional permissions. |
| When you convey a copy of a covered work, you may at your option |
| remove any additional permissions from that copy, or from any part of |
| it. (Additional permissions may be written to require their own |
| removal in certain cases when you modify the work.) You may place |
| additional permissions on material, added by you to a covered work, |
| for which you have or can give appropriate copyright permission. |
| Notwithstanding any other provision of this License, for material you |
| add to a covered work, you may (if authorized by the copyright holders of |
| that material) supplement the terms of this License with terms: |
| a) Disclaiming warranty or limiting liability differently from the |
| terms of sections 15 and 16 of this License; or |
| b) Requiring preservation of specified reasonable legal notices or |
| author attributions in that material or in the Appropriate Legal |
| Notices displayed by works containing it; or |
| c) Prohibiting misrepresentation of the origin of that material, or |
| requiring that modified versions of such material be marked in |
| reasonable ways as different from the original version; or |
| d) Limiting the use for publicity purposes of names of licensors or |
| authors of the material; or |
| e) Declining to grant rights under trademark law for use of some |
| trade names, trademarks, or service marks; or |
| f) Requiring indemnification of licensors and authors of that |
| material by anyone who conveys the material (or modified versions of |
| it) with contractual assumptions of liability to the recipient, for |
| any liability that these contractual assumptions directly impose on |
| those licensors and authors. |
| All other non-permissive additional terms are considered "further |
| restrictions" within the meaning of section 10. If the Program as you |
| received it, or any part of it, contains a notice stating that it is |
| governed by this License along with a term that is a further |
| restriction, you may remove that term. If a license document contains |
| a further restriction but permits relicensing or conveying under this |
| License, you may add to a covered work material governed by the terms |
| of that license document, provided that the further restriction does |
| not survive such relicensing or conveying. |
| If you add terms to a covered work in accord with this section, you |
| must place, in the relevant source files, a statement of the |
| additional terms that apply to those files, or a notice indicating |
| where to find the applicable terms. |
| Additional terms, permissive or non-permissive, may be stated in the |
| form of a separately written license, or stated as exceptions; |
| the above requirements apply either way. |
| 8. Termination. |
| You may not propagate or modify a covered work except as expressly |
| provided under this License. Any attempt otherwise to propagate or |
| modify it is void, and will automatically terminate your rights under |
| this License (including any patent licenses granted under the third |
| paragraph of section 11). |
| However, if you cease all violation of this License, then your |
| license from a particular copyright holder is reinstated (a) |
| provisionally, unless and until the copyright holder explicitly and |
| finally terminates your license, and (b) permanently, if the copyright |
| holder fails to notify you of the violation by some reasonable means |
| prior to 60 days after the cessation. |
| Moreover, your license from a particular copyright holder is |
| reinstated permanently if the copyright holder notifies you of the |
| violation by some reasonable means, this is the first time you have |
| received notice of violation of this License (for any work) from that |
| copyright holder, and you cure the violation prior to 30 days after |
| your receipt of the notice. |
| Termination of your rights under this section does not terminate the |
| licenses of parties who have received copies or rights from you under |
| this License. If your rights have been terminated and not permanently |
| reinstated, you do not qualify to receive new licenses for the same |
| material under section 10. |
| 9. Acceptance Not Required for Having Copies. |
| You are not required to accept this License in order to receive or |
| run a copy of the Program. Ancillary propagation of a covered work |
| occurring solely as a consequence of using peer-to-peer transmission |
| to receive a copy likewise does not require acceptance. However, |
| nothing other than this License grants you permission to propagate or |
| modify any covered work. These actions infringe copyright if you do |
| not accept this License. Therefore, by modifying or propagating a |
| covered work, you indicate your acceptance of this License to do so. |
| 10. Automatic Licensing of Downstream Recipients. |
| Each time you convey a covered work, the recipient automatically |
| receives a license from the original licensors, to run, modify and |
| propagate that work, subject to this License. You are not responsible |
| for enforcing compliance by third parties with this License. |
| An "entity transaction" is a transaction transferring control of an |
| organization, or substantially all assets of one, or subdividing an |
| organization, or merging organizations. If propagation of a covered |
| work results from an entity transaction, each party to that |
| transaction who receives a copy of the work also receives whatever |
| licenses to the work the party's predecessor in interest had or could |
| give under the previous paragraph, plus a right to possession of the |
| Corresponding Source of the work from the predecessor in interest, if |
| the predecessor has it or can get it with reasonable efforts. |
| You may not impose any further restrictions on the exercise of the |
| rights granted or affirmed under this License. For example, you may |
| not impose a license fee, royalty, or other charge for exercise of |
| rights granted under this License, and you may not initiate litigation |
| (including a cross-claim or counterclaim in a lawsuit) alleging that |
| any patent claim is infringed by making, using, selling, offering for |
| sale, or importing the Program or any portion of it. |
| 11. Patents. |
| A "contributor" is a copyright holder who authorizes use under this |
| License of the Program or a work on which the Program is based. The |
| work thus licensed is called the contributor's "contributor version". |
| A contributor's "essential patent claims" are all patent claims |
| owned or controlled by the contributor, whether already acquired or |
| hereafter acquired, that would be infringed by some manner, permitted |
| by this License, of making, using, or selling its contributor version, |
| but do not include claims that would be infringed only as a |
| consequence of further modification of the contributor version. For |
| purposes of this definition, "control" includes the right to grant |
| patent sublicenses in a manner consistent with the requirements of |
| this License. |
| Each contributor grants you a non-exclusive, worldwide, royalty-free |
| patent license under the contributor's essential patent claims, to |
| make, use, sell, offer for sale, import and otherwise run, modify and |
| propagate the contents of its contributor version. |
| In the following three paragraphs, a "patent license" is any express |
| agreement or commitment, however denominated, not to enforce a patent |
| (such as an express permission to practice a patent or covenant not to |
| sue for patent infringement). To "grant" such a patent license to a |
| party means to make such an agreement or commitment not to enforce a |
| patent against the party. |
| If you convey a covered work, knowingly relying on a patent license, |
| and the Corresponding Source of the work is not available for anyone |
| to copy, free of charge and under the terms of this License, through a |
| publicly available network server or other readily accessible means, |
| then you must either (1) cause the Corresponding Source to be so |
| available, or (2) arrange to deprive yourself of the benefit of the |
| patent license for this particular work, or (3) arrange, in a manner |
| consistent with the requirements of this License, to extend the patent |
| license to downstream recipients. "Knowingly relying" means you have |
| actual knowledge that, but for the patent license, your conveying the |
| covered work in a country, or your recipient's use of the covered work |
| in a country, would infringe one or more identifiable patents in that |
| country that you have reason to believe are valid. |
| If, pursuant to or in connection with a single transaction or |
| arrangement, you convey, or propagate by procuring conveyance of, a |
| covered work, and grant a patent license to some of the parties |
| receiving the covered work authorizing them to use, propagate, modify |
| or convey a specific copy of the covered work, then the patent license |
| you grant is automatically extended to all recipients of the covered |
| work and works based on it. |
| A patent license is "discriminatory" if it does not include within |
| the scope of its coverage, prohibits the exercise of, or is |
| conditioned on the non-exercise of one or more of the rights that are |
| specifically granted under this License. You may not convey a covered |
| work if you are a party to an arrangement with a third party that is |
| in the business of distributing software, under which you make payment |
| to the third party based on the extent of your activity of conveying |
| the work, and under which the third party grants, to any of the |
| parties who would receive the covered work from you, a discriminatory |
| patent license (a) in connection with copies of the covered work |
| conveyed by you (or copies made from those copies), or (b) primarily |
| for and in connection with specific products or compilations that |
| contain the covered work, unless you entered into that arrangement, |
| or that patent license was granted, prior to 28 March 2007. |
| Nothing in this License shall be construed as excluding or limiting |
| any implied license or other defenses to infringement that may |
| otherwise be available to you under applicable patent law. |
| 12. No Surrender of Others' Freedom. |
| If conditions are imposed on you (whether by court order, agreement or |
| otherwise) that contradict the conditions of this License, they do not |
| excuse you from the conditions of this License. If you cannot convey a |
| covered work so as to satisfy simultaneously your obligations under this |
| License and any other pertinent obligations, then as a consequence you may |
| not convey it at all. For example, if you agree to terms that obligate you |
| to collect a royalty for further conveying from those to whom you convey |
| the Program, the only way you could satisfy both those terms and this |
| License would be to refrain entirely from conveying the Program. |
| 13. Use with the GNU Affero General Public License. |
| Notwithstanding any other provision of this License, you have |
| permission to link or combine any covered work with a work licensed |
| under version 3 of the GNU Affero General Public License into a single |
| combined work, and to convey the resulting work. The terms of this |
| License will continue to apply to the part which is the covered work, |
| but the special requirements of the GNU Affero General Public License, |
| section 13, concerning interaction through a network will apply to the |
| combination as such. |
| 14. Revised Versions of this License. |
| The Free Software Foundation may publish revised and/or new versions of |
| the GNU General Public License from time to time. Such new versions will |
| be similar in spirit to the present version, but may differ in detail to |
| address new problems or concerns. |
| Each version is given a distinguishing version number. If the |
| Program specifies that a certain numbered version of the GNU General |
| Public License "or any later version" applies to it, you have the |
| option of following the terms and conditions either of that numbered |
| version or of any later version published by the Free Software |
| Foundation. If the Program does not specify a version number of the |
| GNU General Public License, you may choose any version ever published |
| by the Free Software Foundation. |
| If the Program specifies that a proxy can decide which future |
| versions of the GNU General Public License can be used, that proxy's |
| public statement of acceptance of a version permanently authorizes you |
| to choose that version for the Program. |
| Later license versions may give you additional or different |
| permissions. However, no additional obligations are imposed on any |
| author or copyright holder as a result of your choosing to follow a |
| later version. |
| 15. Disclaimer of Warranty. |
| THERE IS NO WARRANTY FOR THE PROGRAM, TO THE EXTENT PERMITTED BY |
| APPLICABLE LAW. EXCEPT WHEN OTHERWISE STATED IN WRITING THE COPYRIGHT |
| HOLDERS AND/OR OTHER PARTIES PROVIDE THE PROGRAM "AS IS" WITHOUT WARRANTY |
| OF ANY KIND, EITHER EXPRESSED OR IMPLIED, INCLUDING, BUT NOT LIMITED TO, |
| THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR |
| PURPOSE. THE ENTIRE RISK AS TO THE QUALITY AND PERFORMANCE OF THE PROGRAM |
| IS WITH YOU. SHOULD THE PROGRAM PROVE DEFECTIVE, YOU ASSUME THE COST OF |
| ALL NECESSARY SERVICING, REPAIR OR CORRECTION. |
| 16. Limitation of Liability. |
| IN NO EVENT UNLESS REQUIRED BY APPLICABLE LAW OR AGREED TO IN WRITING |
| WILL ANY COPYRIGHT HOLDER, OR ANY OTHER PARTY WHO MODIFIES AND/OR CONVEYS |
| THE PROGRAM AS PERMITTED ABOVE, BE LIABLE TO YOU FOR DAMAGES, INCLUDING ANY |
| GENERAL, SPECIAL, INCIDENTAL OR CONSEQUENTIAL DAMAGES ARISING OUT OF THE |
| USE OR INABILITY TO USE THE PROGRAM (INCLUDING BUT NOT LIMITED TO LOSS OF |
| DATA OR DATA BEING RENDERED INACCURATE OR LOSSES SUSTAINED BY YOU OR THIRD |
| PARTIES OR A FAILURE OF THE PROGRAM TO OPERATE WITH ANY OTHER PROGRAMS), |
| EVEN IF SUCH HOLDER OR OTHER PARTY HAS BEEN ADVISED OF THE POSSIBILITY OF |
| SUCH DAMAGES. |
| 17. Interpretation of Sections 15 and 16. |
| If the disclaimer of warranty and limitation of liability provided |
| above cannot be given local legal effect according to their terms, |
| reviewing courts shall apply local law that most closely approximates |
| an absolute waiver of all civil liability in connection with the |
| Program, unless a warranty or assumption of liability accompanies a |
| copy of the Program in return for a fee. |
| END OF TERMS AND CONDITIONS |
| How to Apply These Terms to Your New Programs |
| If you develop a new program, and you want it to be of the greatest |
| possible use to the public, the best way to achieve this is to make it |
| free software which everyone can redistribute and change under these terms. |
| To do so, attach the following notices to the program. It is safest |
| to attach them to the start of each source file to most effectively |
| state the exclusion of warranty; and each file should have at least |
| the "copyright" line and a pointer to where the full notice is found. |
| <one line to give the program's name and a brief idea of what it does.> |
| Copyright (C) <year> <name of author> |
| This program is free software: you can redistribute it and/or modify |
| it under the terms of the GNU General Public License as published by |
| the Free Software Foundation, either version 3 of the License, or |
| (at your option) any later version. |
| This program is distributed in the hope that it will be useful, |
| but WITHOUT ANY WARRANTY; without even the implied warranty of |
| MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| GNU General Public License for more details. |
| You should have received a copy of the GNU General Public License |
| along with this program. If not, see <http://www.gnu.org/licenses/>. |
| Also add information on how to contact you by electronic and paper mail. |
| If the program does terminal interaction, make it output a short |
| notice like this when it starts in an interactive mode: |
| <program> Copyright (C) <year> <name of author> |
| This program comes with ABSOLUTELY NO WARRANTY; for details type `show w'. |
| This is free software, and you are welcome to redistribute it |
| under certain conditions; type `show c' for details. |
| The hypothetical commands `show w' and `show c' should show the appropriate |
| parts of the General Public License. Of course, your program's commands |
| might be different; for a GUI interface, you would use an "about box". |
| You should also get your employer (if you work as a programmer) or school, |
| if any, to sign a "copyright disclaimer" for the program, if necessary. |
| For more information on this, and how to apply and follow the GNU GPL, see |
| <http://www.gnu.org/licenses/>. |
| The GNU General Public License does not permit incorporating your program |
| into proprietary programs. If your program is a subroutine library, you |
| may consider it more useful to permit linking proprietary applications with |
| the library. If this is what you want to do, use the GNU Lesser General |
| Public License instead of this License. But first, please read |
| <http://www.gnu.org/philosophy/why-not-lgpl.html>. |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/License_LPGL.txt |
|---|
| 0,0 → 1,165 |
| GNU LESSER GENERAL PUBLIC LICENSE |
| Version 3, 29 June 2007 |
| Copyright (C) 2007 Free Software Foundation, Inc. <http://fsf.org/> |
| Everyone is permitted to copy and distribute verbatim copies |
| of this license document, but changing it is not allowed. |
| This version of the GNU Lesser General Public License incorporates |
| the terms and conditions of version 3 of the GNU General Public |
| License, supplemented by the additional permissions listed below. |
| 0. Additional Definitions. |
| As used herein, "this License" refers to version 3 of the GNU Lesser |
| General Public License, and the "GNU GPL" refers to version 3 of the GNU |
| General Public License. |
| "The Library" refers to a covered work governed by this License, |
| other than an Application or a Combined Work as defined below. |
| An "Application" is any work that makes use of an interface provided |
| by the Library, but which is not otherwise based on the Library. |
| Defining a subclass of a class defined by the Library is deemed a mode |
| of using an interface provided by the Library. |
| A "Combined Work" is a work produced by combining or linking an |
| Application with the Library. The particular version of the Library |
| with which the Combined Work was made is also called the "Linked |
| Version". |
| The "Minimal Corresponding Source" for a Combined Work means the |
| Corresponding Source for the Combined Work, excluding any source code |
| for portions of the Combined Work that, considered in isolation, are |
| based on the Application, and not on the Linked Version. |
| The "Corresponding Application Code" for a Combined Work means the |
| object code and/or source code for the Application, including any data |
| and utility programs needed for reproducing the Combined Work from the |
| Application, but excluding the System Libraries of the Combined Work. |
| 1. Exception to Section 3 of the GNU GPL. |
| You may convey a covered work under sections 3 and 4 of this License |
| without being bound by section 3 of the GNU GPL. |
| 2. Conveying Modified Versions. |
| If you modify a copy of the Library, and, in your modifications, a |
| facility refers to a function or data to be supplied by an Application |
| that uses the facility (other than as an argument passed when the |
| facility is invoked), then you may convey a copy of the modified |
| version: |
| a) under this License, provided that you make a good faith effort to |
| ensure that, in the event an Application does not supply the |
| function or data, the facility still operates, and performs |
| whatever part of its purpose remains meaningful, or |
| b) under the GNU GPL, with none of the additional permissions of |
| this License applicable to that copy. |
| 3. Object Code Incorporating Material from Library Header Files. |
| The object code form of an Application may incorporate material from |
| a header file that is part of the Library. You may convey such object |
| code under terms of your choice, provided that, if the incorporated |
| material is not limited to numerical parameters, data structure |
| layouts and accessors, or small macros, inline functions and templates |
| (ten or fewer lines in length), you do both of the following: |
| a) Give prominent notice with each copy of the object code that the |
| Library is used in it and that the Library and its use are |
| covered by this License. |
| b) Accompany the object code with a copy of the GNU GPL and this license |
| document. |
| 4. Combined Works. |
| You may convey a Combined Work under terms of your choice that, |
| taken together, effectively do not restrict modification of the |
| portions of the Library contained in the Combined Work and reverse |
| engineering for debugging such modifications, if you also do each of |
| the following: |
| a) Give prominent notice with each copy of the Combined Work that |
| the Library is used in it and that the Library and its use are |
| covered by this License. |
| b) Accompany the Combined Work with a copy of the GNU GPL and this license |
| document. |
| c) For a Combined Work that displays copyright notices during |
| execution, include the copyright notice for the Library among |
| these notices, as well as a reference directing the user to the |
| copies of the GNU GPL and this license document. |
| d) Do one of the following: |
| 0) Convey the Minimal Corresponding Source under the terms of this |
| License, and the Corresponding Application Code in a form |
| suitable for, and under terms that permit, the user to |
| recombine or relink the Application with a modified version of |
| the Linked Version to produce a modified Combined Work, in the |
| manner specified by section 6 of the GNU GPL for conveying |
| Corresponding Source. |
| 1) Use a suitable shared library mechanism for linking with the |
| Library. A suitable mechanism is one that (a) uses at run time |
| a copy of the Library already present on the user's computer |
| system, and (b) will operate properly with a modified version |
| of the Library that is interface-compatible with the Linked |
| Version. |
| e) Provide Installation Information, but only if you would otherwise |
| be required to provide such information under section 6 of the |
| GNU GPL, and only to the extent that such information is |
| necessary to install and execute a modified version of the |
| Combined Work produced by recombining or relinking the |
| Application with a modified version of the Linked Version. (If |
| you use option 4d0, the Installation Information must accompany |
| the Minimal Corresponding Source and Corresponding Application |
| Code. If you use option 4d1, you must provide the Installation |
| Information in the manner specified by section 6 of the GNU GPL |
| for conveying Corresponding Source.) |
| 5. Combined Libraries. |
| You may place library facilities that are a work based on the |
| Library side by side in a single library together with other library |
| facilities that are not Applications and are not covered by this |
| License, and convey such a combined library under terms of your |
| choice, if you do both of the following: |
| a) Accompany the combined library with a copy of the same work based |
| on the Library, uncombined with any other library facilities, |
| conveyed under the terms of this License. |
| b) Give prominent notice with the combined library that part of it |
| is a work based on the Library, and explaining where to find the |
| accompanying uncombined form of the same work. |
| 6. Revised Versions of the GNU Lesser General Public License. |
| The Free Software Foundation may publish revised and/or new versions |
| of the GNU Lesser General Public License from time to time. Such new |
| versions will be similar in spirit to the present version, but may |
| differ in detail to address new problems or concerns. |
| Each version is given a distinguishing version number. If the |
| Library as you received it specifies that a certain numbered version |
| of the GNU Lesser General Public License "or any later version" |
| applies to it, you have the option of following the terms and |
| conditions either of that published version or of any later version |
| published by the Free Software Foundation. If the Library as you |
| received it does not specify a version number of the GNU Lesser |
| General Public License, you may choose any version of the GNU Lesser |
| General Public License ever published by the Free Software Foundation. |
| If the Library as you received it specifies that a proxy can decide |
| whether future versions of the GNU Lesser General Public License shall |
| apply, that proxy's public statement of acceptance of any version is |
| permanent authorization for you to choose that version for the |
| Library. |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/License_buss.txt |
|---|
| 0,0 → 1,52 |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Copyright (c) 04.2007 Holger Buss |
| // + Nur für den privaten Gebrauch |
| // + www.MikroKopter.com |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Es gilt für das gesamte Projekt (Hardware, Software, Binärfiles, Sourcecode und Dokumentation), |
| // + dass eine Nutzung (auch auszugsweise) nur für den privaten und nichtkommerziellen Gebrauch zulässig ist. |
| // + Sollten direkte oder indirekte kommerzielle Absichten verfolgt werden, ist mit uns (info@mikrokopter.de) Kontakt |
| // + bzgl. der Nutzungsbedingungen aufzunehmen. |
| // + Eine kommerzielle Nutzung ist z.B.Verkauf von MikroKoptern, Bestückung und Verkauf von Platinen oder Bausätzen, |
| // + Verkauf von Luftbildaufnahmen, usw. |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Werden Teile des Quellcodes (mit oder ohne Modifikation) weiterverwendet oder veröffentlicht, |
| // + unterliegen sie auch diesen Nutzungsbedingungen und diese Nutzungsbedingungen incl. Copyright müssen dann beiliegen |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Sollte die Software (auch auszugesweise) oder sonstige Informationen des MikroKopter-Projekts |
| // + auf anderen Webseiten oder sonstigen Medien veröffentlicht werden, muss unsere Webseite "http://www.mikrokopter.de" |
| // + eindeutig als Ursprung verlinkt und genannt werden |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Keine Gewähr auf Fehlerfreiheit, Vollständigkeit oder Funktion |
| // + Benutzung auf eigene Gefahr |
| // + Wir übernehmen keinerlei Haftung für direkte oder indirekte Personen- oder Sachschäden |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Die Portierung der Software (oder Teile davon) auf andere Systeme (ausser der Hardware von www.mikrokopter.de) ist nur |
| // + mit unserer Zustimmung zulässig |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Die Funktion printf_P() unterliegt ihrer eigenen Lizenz und ist hiervon nicht betroffen |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Redistributions of source code (with or without modifications) must retain the above copyright notice, |
| // + this list of conditions and the following disclaimer. |
| // + * Neither the name of the copyright holders nor the names of contributors may be used to endorse or promote products derived |
| // + from this software without specific prior written permission. |
| // + * The use of this project (hardware, software, binary files, sources and documentation) is only permittet |
| // + for non-profit use (directly or indirectly) |
| // + Commercial use (for excample: selling of MikroKopters, selling of PCBs, assembly, ...) is only permitted |
| // + with our written permission |
| // + * If sources or documentations are redistributet, our webpage (http://www.MikroKopter.de) must be |
| // + clearly linked and named as origin |
| // + * porting to systems other than hardware from www.mikrokopter.de is not allowed |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
| // + AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| // + IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| // + ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE |
| // + LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| // + CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| // + SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
| // + INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
| // + CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
| // + ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| // + POSSIBILITY OF SUCH DAMAGE. |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/README_Gps.txt |
|---|
| 0,0 → 1,77 |
| ********************************************************************* |
| GPS Implementierung von Peter Muehlenbrock ("Salvo") für Mikrokopter/FlightCrtl |
| Stand 21.12.2007 |
| Verwendung der SW ohne Gewaehr. Siehe auch die Lizenzbedingungen in File Licensce_LPGL.txt und Licensce_GPL.txt |
| Die Version basiert auf Holgers V00.67g. |
| ********************************************************************* |
| Hardware-Voraussetzungen: |
| Kalibrierter Kompass vom Typ CMPS03, waagrecht eingebaut |
| GPS Modul vom Typ ublox, Die Meldungungen "NAV_STATUS", "NAV_POSUTM" und "NAV_VELNED" |
| mussen mit 4 HZ Updaterate aktiviert sein. Alle Meldungen im NMEA Format muessen deaktivert sein. |
| Anschluss an RX Port der FlightCRtl. Baudrate ist 57600 wie beim Kopter Tool. |
| Software-Voraussetzungen: |
| In timer0.h muss die Ausrichtung des Kompasses bezogen auf die Nordachse des Kopters |
| eingetragen sein. KOMPASS_OFFSET (im hexfile =135 Grad) legt diesen Wert fest. |
| Betriebs-Voraussetzungen: |
| Damit der Kompass sauber funktioniert, muss die waagrechte Lage (Gashebel Vollanschlag und Gier rechts) |
| im Eeprom abgespeichert worden sein. |
| Parametrierung: |
| Der GPS Hold Regler ist ein PID Regler, der ueber die UserParameter1(P), 2(I) und D(3) gesteuert wird. |
| UserParameter1 beschreibt den P-Anteil, UserParameter2 den I-Anteil und UserParameter3 den D-Anteil. |
| Hier kann und muss gespielt werden.Alle Parameter koennen direkt im Mikrokoptertool in den Settings eingestellt werden. |
| Standardwert ist 128 für den P-Anteil, 16 für den I-Anteil und 160 für den D-Anteil. |
| Je größer die Werte desto "ruckeliger" reagiert die Regelung aber desto schneller und stärker greift sie auch. |
| Wenn alle 0 sind, ist der Regler deaktiviert. |
| Voraussetzungen für GPS_Hold: |
| Neben den genannten HW und SW Voraussetzungen muß beim Kalibrieren das GPS MOdul bereits Positionsdaten liefern. |
| Nur dann wird die Home Position abgespeichert und nur dann wird GPS_Hold aktiviert. |
| Kenntlich gemacht wird dies durch einen etwas längeren Piepser nach dem Kalibrieren. |
| Das GPS Aktiv Flag im Setting muss aktiviert sein. |
| Eine Ausrichtung des Kopters nach Nord etc. ist nicht erforderlich. |
| Aktivierung GPS_Hold im Flug: |
| Wenn alle genannten Voraussetzungen erfüllt sind, wird GPS Hold im Flug automatisch aktiviert, sobald der Nick und Roll Stick |
| fürca. 500msec in Neutrallage sind. Weicht einer der Sticks davon ab (Parameter GPS_STICK_HOLDOFF) oder liefert das GPS Modul oder fällt der |
| Kompass aus wird GPS_Hold sofort deaktiviert. |
| Damit kann jederzeit die manuelle Kontrolle wieder übernommen werden. |
| GPS_Hold regelt nur horizontale Abweichungen, keine Hoehe. |
| Der Magnetkompass wird nur in waagrechter Lage dazu benutzt einen internen aus dem Giergyro ermittelten "Ersatz"kompasswert |
| nach zu kalibrieren. Daher funktioniert die Bstimmung der Kopterausrichtung in jeder Lebenslage, sofern nur ab und zu |
| der Magnetkompass in die waagrechte Lage kommt. |
| Ein 3D Kompass ist damit überflüssig. |
| GPS Rücksturz zur Basis (GPS Home) Funktion |
| Voraussetzungen wie bei GPS Hold. |
| Die Funktion kann im Flug aktiviert werden durch Setzen des Hoehenreglerschalters. |
| Holgers Code habe ich so abgeändert daß der Höhenregler mit "Parameter_MaxHoehe" ab 50 aktiviert wird. |
| Mit einem Schalter mit Neutrallage können damit die Funktionen |
| Alles aus - Hoehenregler ein, GPS Home Aus - Hoehenregler Ein UND GPS Home ein |
| aktiviert werden. Ist noch nicht die beste Lösung und werde ich noch anpassen |
| Weitere Änderungen: |
| -Bei Unterschreiten der eingestellten Warnschwelle für UBAT ertönt zunächst wie gewohnt der Piepser. Geht die Spannung weiter |
| runter wird zwangsweise die Gaseinstellung langsam reduziert um den Kopter zum Landen zu bringen. |
| -Der Ausgang PC6 kann benutzt werden um einen Externen Multiplexer zu schalten. Dieser schaltet entweder die GPS Daten |
| (Wenn Motoren eingeschaltet sind) oder den Ausgang des Bluetoothmoduls (wenn Motoren ausgeschaltet sind) auf den RX |
| Eingang der FlightCrtl. Damit kann eine zweite UART Schnittstelle bzw. die manuelle Umschaltung entfallen |
| -Bei vorhandenem Kompass wird eine automatische Kompensation der Giergyrodrift durchgeführt. |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/Settings.h |
|---|
| --- Basis_v0067g/tags/v0002/_Settings.h (nonexistent) |
| +++ Basis_v0067g/tags/v0002/_Settings.h (revision 560) |
| @@ -0,0 +1,50 @@ |
| +// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| +// Testmodi |
| +// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| +#define MOTOR_OFF 0 |
| +#define MOTOR_TEST 0 |
| + |
| +// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| +// Abstimmung |
| +// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| +#define ACC_AMPLIFY 16 |
| +#define FAKTOR_P 1 |
| +#define FAKTOR_I 0.0001 |
| + |
| + |
| +// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| +// Debug-Interface |
| +// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| +#define SIO_DEBUG 1 // Soll der Debugger aktiviert sein? |
| +#define MIN_DEBUG_INTERVALL 250 // in diesem Intervall werden Debugdaten ohne Aufforderung gesendet |
| + |
| +// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| +// Sender |
| +// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| + #define K_NICK 0 |
| + #define K_ROLL 1 |
| + #define K_GAS 2 |
| + #define K_GIER 3 |
| + #define K_POTI1 4 |
| + #define K_POTI2 5 |
| + #define K_POTI3 6 |
| + #define K_POTI4 7 |
| +// +++++++++++++++++++++++++++++++ |
| +// + Getestete Settings: |
| +// +++++++++++++++++++++++++++++++ |
| +// Setting: Kamera |
| +// Stick_P:3 |
| +// Stick_D:0 |
| +// Gyro_P: 175 |
| +// Gyro_I: 175 |
| +// Ki_Anteil: 10 |
| +// +++++++++++++++++++++++++++++++ |
| +// + Getestete Settings: |
| +// +++++++++++++++++++++++++++++++ |
| +// Setting: Normal |
| +// Stick_P:2 |
| +// Stick_D:8 |
| +// Gyro_P: 80 |
| +// Gyro_I: 150 |
| +// Ki_Anteil: 5 |
| + |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/analog.c |
|---|
| 0,0 → 1,145 |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Copyright (c) 04.2007 Holger Buss |
| // + only for non-profit use |
| // + www.MikroKopter.com |
| // + see the File "License.txt" for further Informations |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| #include "main.h" |
| volatile int Aktuell_Nick,Aktuell_Roll,Aktuell_Gier,Aktuell_ax, Aktuell_ay,Aktuell_az, UBat = 100; |
| volatile int AdWertNick = 0, AdWertRoll = 0, AdWertGier = 0; |
| volatile int AdWertAccRoll = 0,AdWertAccNick = 0,AdWertAccHoch = 0; |
| volatile char MessanzahlNick = 0, MessanzahlRoll = 0, MessanzahlGier = 0; |
| volatile char messanzahl_AccNick = 0, messanzahl_AccRoll = 0, messanzahl_AccHoch = 0; |
| volatile long Luftdruck = 32000; |
| volatile int StartLuftdruck; |
| volatile unsigned int MessLuftdruck = 1023; |
| unsigned char DruckOffsetSetting; |
| volatile int HoeheD = 0; |
| volatile char messanzahl_Druck; |
| volatile int tmpLuftdruck; |
| volatile unsigned int ZaehlMessungen = 0; |
| //####################################################################################### |
| // |
| void ADC_Init(void) |
| //####################################################################################### |
| { |
| ADMUX = 0;//Referenz ist extern |
| ADCSRA=(1<<ADEN)|(1<<ADSC)|(1<<ADATE)|(1<<ADPS2)|(1<<ADPS1)|(1<<ADPS0)|(1<<ADIE); |
| //Free Running Mode, Division Factor 128, Interrupt on |
| } |
| void SucheLuftruckOffset(void) |
| { |
| unsigned int off; |
| off = eeprom_read_byte(&EEPromArray[EEPROM_ADR_LAST_OFFSET]); |
| if(off > 20) off -= 10; |
| OCR0A = off; |
| Delay_ms_Mess(100); |
| if(MessLuftdruck < 850) off = 0; |
| for(; off < 250;off++) |
| { |
| OCR0A = off; |
| Delay_ms_Mess(50); |
| printf("."); |
| if(MessLuftdruck < 900) break; |
| } |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_LAST_OFFSET], off); |
| DruckOffsetSetting = off; |
| Delay_ms_Mess(300); |
| } |
| //####################################################################################### |
| // |
| SIGNAL(SIG_ADC) |
| //####################################################################################### |
| { |
| static unsigned char kanal=0,state = 0; |
| static unsigned int gier1, roll1, nick1; |
| ANALOG_OFF; |
| switch(state++) |
| { |
| case 0: |
| gier1 = ADC; |
| kanal = 1; |
| ZaehlMessungen++; |
| break; |
| case 1: |
| roll1 = ADC; |
| kanal = 2; |
| break; |
| case 2: |
| nick1 = ADC; |
| kanal = 4; |
| break; |
| case 3: |
| UBat = (3 * UBat + ADC / 3) / 4;//(UBat + ((ADC * 39) / 256) + 19) / 2; |
| kanal = 6; |
| break; |
| case 4: |
| Aktuell_ay = NeutralAccY - ADC; |
| AdWertAccRoll = Aktuell_ay; |
| kanal = 7; |
| break; |
| case 5: |
| Aktuell_ax = ADC - NeutralAccX; |
| AdWertAccNick = Aktuell_ax; |
| kanal = 0; |
| break; |
| case 6: |
| if(PlatinenVersion == 10) AdWertGier = (ADC + gier1) / 2; |
| else AdWertGier = ADC + gier1; |
| kanal = 1; |
| break; |
| case 7: |
| if(PlatinenVersion == 10) AdWertRoll = (ADC + roll1) / 2; |
| else AdWertRoll = ADC + roll1; |
| kanal = 2; |
| break; |
| case 8: |
| if(PlatinenVersion == 10) AdWertNick = (ADC + nick1) / 2; |
| else AdWertNick = ADC + nick1; |
| kanal = 5; |
| break; |
| case 9: |
| AdWertAccHoch = (signed int) ADC - NeutralAccZ; |
| AdWertAccHoch += abs(Aktuell_ay) / 4 + abs(Aktuell_ax) / 4; |
| if(AdWertAccHoch > 1) |
| { |
| if(NeutralAccZ < 800) NeutralAccZ+= 0.02; |
| } |
| else if(AdWertAccHoch < -1) |
| { |
| if(NeutralAccZ > 600) NeutralAccZ-= 0.02; |
| } |
| messanzahl_AccHoch = 1; |
| Aktuell_az = ADC; |
| Mess_Integral_Hoch += AdWertAccHoch; // Integrieren |
| Mess_Integral_Hoch -= Mess_Integral_Hoch / 1024; // dämfen |
| kanal = 3; |
| break; |
| case 10: |
| tmpLuftdruck += ADC; |
| if(++messanzahl_Druck >= 5) |
| { |
| MessLuftdruck = ADC; |
| messanzahl_Druck = 0; |
| HoeheD = (int)(StartLuftdruck - tmpLuftdruck - HoehenWert); // D-Anteil = neuerWert - AlterWert |
| Luftdruck = (tmpLuftdruck + 3 * Luftdruck) / 4; |
| HoehenWert = StartLuftdruck - Luftdruck; |
| tmpLuftdruck = 0; |
| } |
| kanal = 0; |
| state = 0; |
| break; |
| default: |
| kanal = 0; |
| state = 0; |
| break; |
| } |
| ADMUX = kanal; |
| if(state != 0) ANALOG_ON; |
| } |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/analog.h |
|---|
| 0,0 → 1,24 |
| /*####################################################################################### |
| #######################################################################################*/ |
| extern volatile int UBat; |
| extern volatile int AdWertNick, AdWertRoll, AdWertGier; |
| extern volatile int AdWertAccRoll,AdWertAccNick,AdWertAccHoch; |
| extern volatile int Aktuell_Nick,Aktuell_Roll,Aktuell_Gier,Aktuell_ax, Aktuell_ay,Aktuell_az; |
| extern volatile long Luftdruck; |
| extern volatile char messanzahl_Druck; |
| extern volatile unsigned int ZaehlMessungen; |
| extern unsigned char DruckOffsetSetting; |
| extern volatile int HoeheD; |
| extern volatile unsigned int MessLuftdruck; |
| extern volatile int StartLuftdruck; |
| extern volatile char MessanzahlNick; |
| unsigned int ReadADC(unsigned char adc_input); |
| void ADC_Init(void); |
| void SucheLuftruckOffset(void); |
| #define ANALOG_OFF ADCSRA=0 |
| #define ANALOG_ON ADCSRA=(1<<ADEN)|(1<<ADSC)|(1<<ADATE)|(1<<ADPS2)|(1<<ADPS1)|(1<<ADPS0)|(1<<ADIE) |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/eeprom.c |
|---|
| 0,0 → 1,183 |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Konstanten |
| // + 0-250 -> normale Werte |
| // + 251 -> Poti1 |
| // + 252 -> Poti2 |
| // + 253 -> Poti3 |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| void DefaultKonstanten1(void) |
| { |
| EE_Parameter.Kanalbelegung[K_NICK] = 1; |
| EE_Parameter.Kanalbelegung[K_ROLL] = 2; |
| EE_Parameter.Kanalbelegung[K_GAS] = 3; |
| EE_Parameter.Kanalbelegung[K_GIER] = 4; |
| EE_Parameter.Kanalbelegung[K_POTI1] = 5; |
| EE_Parameter.Kanalbelegung[K_POTI2] = 6; |
| EE_Parameter.Kanalbelegung[K_POTI3] = 7; |
| EE_Parameter.Kanalbelegung[K_POTI4] = 8; |
| EE_Parameter.GlobalConfig = CFG_ACHSENKOPPLUNG_AKTIV;//CFG_HOEHENREGELUNG | /*CFG_HOEHEN_SCHALTER |*/ CFG_KOMPASS_AKTIV | CFG_KOMPASS_FIX;//0x01; |
| EE_Parameter.Hoehe_MinGas = 30; |
| EE_Parameter.MaxHoehe = 251; // Wert : 0-250 251 -> Poti1 |
| EE_Parameter.Hoehe_P = 10; // Wert : 0-32 |
| EE_Parameter.Luftdruck_D = 50; // Wert : 0-250 |
| EE_Parameter.Hoehe_ACC_Wirkung = 50; // Wert : 0-250 |
| EE_Parameter.Hoehe_Verstaerkung = 4; // Wert : 0-50 |
| EE_Parameter.Stick_P = 4; //2 // Wert : 1-6 |
| //EE_Parameter.Stick_D = 8; //8 // Wert : 0-64 |
| EE_Parameter.Stick_D = 4; //8 // Wert : 0-64 Salvo |
| EE_Parameter.Gier_P = 14; // Wert : 1-20 |
| EE_Parameter.Gas_Min = 15; // Wert : 0-32 |
| EE_Parameter.Gas_Max = 250; // Wert : 33-250 |
| EE_Parameter.GyroAccFaktor = 26; // Wert : 1-64 |
| EE_Parameter.KompassWirkung = 128; // Wert : 0-250 |
| EE_Parameter.Gyro_P = 120; //80 // Wert : 0-250 |
| EE_Parameter.Gyro_I = 150; // Wert : 0-250 |
| EE_Parameter.UnterspannungsWarnung = 100; // Wert : 0-250 |
| EE_Parameter.NotGas = 95; // Wert : 0-250 // Gaswert bei Empangsverlust |
| EE_Parameter.NotGasZeit = 60; // Wert : 0-250 // Zeit bis auf NotGas geschaltet wird, wg. Rx-Problemen |
| EE_Parameter.UfoAusrichtung = 0; // X oder + Formation |
| EE_Parameter.I_Faktor = 32; |
| EE_Parameter.UserParam1 = 0; //zur freien Verwendung |
| EE_Parameter.UserParam2 = 0; //zur freien Verwendung |
| EE_Parameter.UserParam3 = 0; //zur freien Verwendung |
| EE_Parameter.UserParam4 = 0; //zur freien Verwendung |
| EE_Parameter.UserParam5 = 0; // zur freien Verwendung |
| EE_Parameter.UserParam6 = 0; // zur freien Verwendung |
| EE_Parameter.UserParam7 = 0; // zur freien Verwendung |
| EE_Parameter.UserParam8 = 0; // zur freien Verwendung |
| EE_Parameter.ServoNickControl = 100; // Wert : 0-250 // Stellung des Servos |
| EE_Parameter.ServoNickComp = 40; // Wert : 0-250 // Einfluss Gyro/Servo |
| EE_Parameter.ServoNickCompInvert = 0; // Wert : 0-250 // Richtung Einfluss Gyro/Servo |
| EE_Parameter.ServoNickMin = 50; // Wert : 0-250 // Anschlag |
| EE_Parameter.ServoNickMax = 150; // Wert : 0-250 // Anschlag |
| EE_Parameter.ServoNickRefresh = 5; |
| EE_Parameter.LoopGasLimit = 50; |
| EE_Parameter.LoopThreshold = 90; // Wert: 0-250 Schwelle für Stickausschlag |
| EE_Parameter.LoopHysterese = 50; |
| EE_Parameter.LoopConfig = 0; // Bitcodiert: 0x01=oben, 0x02=unten, 0x04=links, 0x08=rechts / wird getrennt behandelt |
| EE_Parameter.AchsKopplung1 = 100; |
| EE_Parameter.AchsGegenKopplung1 = 10; |
| EE_Parameter.WinkelUmschlagNick = 100; |
| EE_Parameter.WinkelUmschlagRoll = 100; |
| EE_Parameter.GyroAccAbgleich = 50; // 1/k |
| EE_Parameter.Driftkomp = 4; |
| EE_Parameter.DynamicStability = 100; |
| memcpy(EE_Parameter.Name, "Sport\0", 12); |
| } |
| void DefaultKonstanten2(void) |
| { |
| EE_Parameter.Kanalbelegung[K_NICK] = 1; |
| EE_Parameter.Kanalbelegung[K_ROLL] = 2; |
| EE_Parameter.Kanalbelegung[K_GAS] = 3; |
| EE_Parameter.Kanalbelegung[K_GIER] = 4; |
| EE_Parameter.Kanalbelegung[K_POTI1] = 5; |
| EE_Parameter.Kanalbelegung[K_POTI2] = 6; |
| EE_Parameter.Kanalbelegung[K_POTI3] = 7; |
| EE_Parameter.Kanalbelegung[K_POTI4] = 8; |
| EE_Parameter.GlobalConfig = CFG_ACHSENKOPPLUNG_AKTIV;//CFG_HOEHENREGELUNG | /*CFG_HOEHEN_SCHALTER |*/ CFG_KOMPASS_AKTIV;//0x01; |
| EE_Parameter.Hoehe_MinGas = 30; |
| EE_Parameter.MaxHoehe = 251; // Wert : 0-250 251 -> Poti1 |
| EE_Parameter.Hoehe_P = 10; // Wert : 0-32 |
| EE_Parameter.Luftdruck_D = 50; // Wert : 0-250 |
| EE_Parameter.Hoehe_ACC_Wirkung = 50; // Wert : 0-250 |
| EE_Parameter.Hoehe_Verstaerkung = 2; // Wert : 0-50 |
| EE_Parameter.Stick_P = 4; //2 // Wert : 1-6 |
| EE_Parameter.Stick_D = 0; //8 // Wert : 0-64 |
| EE_Parameter.Gier_P = 10; // Wert : 1-20 |
| EE_Parameter.Gas_Min = 15; // Wert : 0-32 |
| EE_Parameter.Gas_Max = 250; // Wert : 33-250 |
| EE_Parameter.GyroAccFaktor = 26; // Wert : 1-64 |
| EE_Parameter.KompassWirkung = 128; // Wert : 0-250 |
| EE_Parameter.Gyro_P = 175; //80 // Wert : 0-250 |
| EE_Parameter.Gyro_I = 175; // Wert : 0-250 |
| EE_Parameter.UnterspannungsWarnung = 100; // Wert : 0-250 |
| EE_Parameter.NotGas = 95; // Wert : 0-250 // Gaswert bei Empangsverlust |
| EE_Parameter.NotGasZeit = 60; // Wert : 0-250 // Zeit bis auf NotGas geschaltet wird, wg. Rx-Problemen |
| EE_Parameter.UfoAusrichtung = 0; // X oder + Formation |
| EE_Parameter.I_Faktor = 32; |
| EE_Parameter.UserParam1 = 20 * 4; // zur freien Verwendung |
| EE_Parameter.UserParam2 = 0; // zur freien Verwendung |
| EE_Parameter.UserParam3 = 0; // zur freien Verwendung |
| EE_Parameter.UserParam4 = 0; // zur freien Verwendung |
| EE_Parameter.UserParam5 = 0; // zur freien Verwendung |
| EE_Parameter.UserParam6 = 0; // zur freien Verwendung |
| EE_Parameter.UserParam7 = 0; // zur freien Verwendung |
| EE_Parameter.UserParam8 = 0; // zur freien Verwendung |
| EE_Parameter.ServoNickControl = 100; // Wert : 0-250 // Stellung des Servos |
| EE_Parameter.ServoNickComp = 40; // Wert : 0-250 // Einfluss Gyro/Servo |
| EE_Parameter.ServoNickCompInvert = 0; // Wert : 0-250 // Richtung Einfluss Gyro/Servo |
| EE_Parameter.ServoNickMin = 50; // Wert : 0-250 // Anschlag |
| EE_Parameter.ServoNickMax = 150; // Wert : 0-250 // Anschlag |
| EE_Parameter.ServoNickRefresh = 5; |
| EE_Parameter.LoopGasLimit = 50; |
| EE_Parameter.LoopThreshold = 90; // Wert: 0-250 Schwelle für Stickausschlag |
| EE_Parameter.LoopHysterese = 50; |
| EE_Parameter.LoopConfig = 0; // Bitcodiert: 0x01=oben, 0x02=unten, 0x04=links, 0x08=rechts |
| EE_Parameter.AchsKopplung1 = 100; // Faktor, mit dem Gier die Achsen Roll und Nick verkoppelt |
| EE_Parameter.AchsGegenKopplung1 = 10; |
| EE_Parameter.WinkelUmschlagNick = 100; |
| EE_Parameter.WinkelUmschlagRoll = 100; |
| EE_Parameter.GyroAccAbgleich = 100; // 1/k |
| EE_Parameter.Driftkomp = 4; |
| EE_Parameter.DynamicStability = 75; |
| memcpy(EE_Parameter.Name, "Normal\0", 12); |
| } |
| void DefaultKonstanten3(void) |
| { |
| EE_Parameter.Kanalbelegung[K_NICK] = 1; |
| EE_Parameter.Kanalbelegung[K_ROLL] = 2; |
| EE_Parameter.Kanalbelegung[K_GAS] = 3; |
| EE_Parameter.Kanalbelegung[K_GIER] = 4; |
| EE_Parameter.Kanalbelegung[K_POTI1] = 5; |
| EE_Parameter.Kanalbelegung[K_POTI2] = 6; |
| EE_Parameter.Kanalbelegung[K_POTI3] = 7; |
| EE_Parameter.Kanalbelegung[K_POTI4] = 8; |
| EE_Parameter.GlobalConfig = CFG_DREHRATEN_BEGRENZER | CFG_ACHSENKOPPLUNG_AKTIV;///*CFG_HOEHEN_SCHALTER |*/ CFG_KOMPASS_AKTIV;//0x01; |
| EE_Parameter.Hoehe_MinGas = 30; |
| EE_Parameter.MaxHoehe = 251; // Wert : 0-250 251 -> Poti1 |
| EE_Parameter.Hoehe_P = 10; // Wert : 0-32 |
| EE_Parameter.Luftdruck_D = 50; // Wert : 0-250 |
| EE_Parameter.Hoehe_ACC_Wirkung = 50; // Wert : 0-250 |
| EE_Parameter.Hoehe_Verstaerkung = 2; // Wert : 0-50 |
| EE_Parameter.Stick_P = 3; //2 // Wert : 1-6 |
| EE_Parameter.Stick_D = 0; //8 // Wert : 0-64 |
| EE_Parameter.Gier_P = 8; // Wert : 1-20 |
| EE_Parameter.Gas_Min = 15; // Wert : 0-32 |
| EE_Parameter.Gas_Max = 250; // Wert : 33-250 |
| EE_Parameter.GyroAccFaktor = 26; // Wert : 1-64 |
| EE_Parameter.KompassWirkung = 128; // Wert : 0-250 |
| EE_Parameter.Gyro_P = 200; //80 // Wert : 0-250 |
| EE_Parameter.Gyro_I = 175; // Wert : 0-250 |
| EE_Parameter.UnterspannungsWarnung = 100; // Wert : 0-250 |
| EE_Parameter.NotGas = 95; // Wert : 0-250 // Gaswert bei Empangsverlust |
| EE_Parameter.NotGasZeit = 60; // Wert : 0-250 // Zeit bis auf NotGas geschaltet wird, wg. Rx-Problemen |
| EE_Parameter.UfoAusrichtung = 0; // X oder + Formation |
| EE_Parameter.I_Faktor = 10; |
| EE_Parameter.UserParam1 = 20 * 4; // zur freien Verwendung |
| EE_Parameter.UserParam2 = 0; // zur freien Verwendung |
| EE_Parameter.UserParam3 = 0; // zur freien Verwendung |
| EE_Parameter.UserParam4 = 0; // zur freien Verwendung |
| EE_Parameter.UserParam5 = 0; // zur freien Verwendung |
| EE_Parameter.UserParam6 = 0; // zur freien Verwendung |
| EE_Parameter.UserParam7 = 0; // zur freien Verwendung |
| EE_Parameter.UserParam8 = 0; // zur freien Verwendung |
| EE_Parameter.ServoNickControl = 100; // Wert : 0-250 // Stellung des Servos |
| EE_Parameter.ServoNickComp = 40; // Wert : 0-250 // Einfluss Gyro/Servo |
| EE_Parameter.ServoNickCompInvert = 0; // Wert : 0-250 // Richtung Einfluss Gyro/Servo |
| EE_Parameter.ServoNickMin = 50; // Wert : 0-250 // Anschlag |
| EE_Parameter.ServoNickMax = 150; // Wert : 0-250 // Anschlag |
| EE_Parameter.ServoNickRefresh = 5; |
| EE_Parameter.LoopGasLimit = 50; |
| EE_Parameter.LoopThreshold = 90; // Wert: 0-250 Schwelle für Stickausschlag |
| EE_Parameter.LoopHysterese = 50; |
| EE_Parameter.LoopConfig = 0; // Bitcodiert: 0x01=oben, 0x02=unten, 0x04=links, 0x08=rechts |
| EE_Parameter.AchsKopplung1 = 100; // Faktor, mit dem Gier die Achsen Roll und Nick verkoppelt |
| EE_Parameter.AchsGegenKopplung1 = 10; |
| EE_Parameter.WinkelUmschlagNick = 100; |
| EE_Parameter.WinkelUmschlagRoll = 100; |
| EE_Parameter.GyroAccAbgleich = 100; // 1/k |
| EE_Parameter.Driftkomp = 4; |
| EE_Parameter.DynamicStability = 50; |
| memcpy(EE_Parameter.Name, "Beginner\0", 12); |
| } |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/fc.c |
|---|
| 0,0 → 1,1363 |
| /*####################################################################################### |
| Flight Control |
| #######################################################################################*/ |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Copyright (c) 04.2007 Holger Buss |
| // + Nur für den privaten Gebrauch |
| // + www.MikroKopter.com |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Es gilt für das gesamte Projekt (Hardware, Software, Binärfiles, Sourcecode und Dokumentation), |
| // + dass eine Nutzung (auch auszugsweise) nur für den privaten (nicht-kommerziellen) Gebrauch zulässig ist. |
| // + Sollten direkte oder indirekte kommerzielle Absichten verfolgt werden, ist mit uns (info@mikrokopter.de) Kontakt |
| // + bzgl. der Nutzungsbedingungen aufzunehmen. |
| // + Eine kommerzielle Nutzung ist z.B.Verkauf von MikroKoptern, Bestückung und Verkauf von Platinen oder Bausätzen, |
| // + Verkauf von Luftbildaufnahmen, usw. |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Werden Teile des Quellcodes (mit oder ohne Modifikation) weiterverwendet oder veröffentlicht, |
| // + unterliegen sie auch diesen Nutzungsbedingungen und diese Nutzungsbedingungen incl. Copyright müssen dann beiliegen |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Sollte die Software (auch auszugesweise) oder sonstige Informationen des MikroKopter-Projekts |
| // + auf anderen Webseiten oder sonstigen Medien veröffentlicht werden, muss unsere Webseite "http://www.mikrokopter.de" |
| // + eindeutig als Ursprung verlinkt werden |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Keine Gewähr auf Fehlerfreiheit, Vollständigkeit oder Funktion |
| // + Benutzung auf eigene Gefahr |
| // + Wir übernehmen keinerlei Haftung für direkte oder indirekte Personen- oder Sachschäden |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Die Portierung der Software (oder Teile davon) auf andere Systeme (ausser der Hardware von www.mikrokopter.de) ist nur |
| // + mit unserer Zustimmung zulässig |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Die Funktion printf_P() unterliegt ihrer eigenen Lizenz und ist hiervon nicht betroffen |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Redistributions of source code (with or without modifications) must retain the above copyright notice, |
| // + this list of conditions and the following disclaimer. |
| // + * Neither the name of the copyright holders nor the names of contributors may be used to endorse or promote products derived |
| // + from this software without specific prior written permission. |
| // + * The use of this project (hardware, software, binary files, sources and documentation) is only permittet |
| // + for non-commercial use (directly or indirectly) |
| // + Commercial use (for excample: selling of MikroKopters, selling of PCBs, assembly, ...) is only permitted |
| // + with our written permission |
| // + * If sources or documentations are redistributet on other webpages, out webpage (http://www.MikroKopter.de) must be |
| // + clearly linked as origin |
| // + * porting to systems other than hardware from www.mikrokopter.de is not allowed |
| // + THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
| // + AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| // + IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| // + ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE |
| // + LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| // + CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| // + SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
| // + INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN// + CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
| // + ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| // + POSSIBILITY OF SUCH DAMAGE. |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Aenderungen von Peter Muehlenbrock ("Salvo") Stand 6.10.2007 |
| /* |
| Driftkompensation fuer Gyros verbessert |
| Linearsensor mit fixem Neutralwert |
| Ersatzkompass abgeleitet aus Magnetkompass und Giergyro fuer nahezu neigungsunabhaengige Kompassfunktion |
| */ |
| #include "main.h" |
| #include "eeprom.c" |
| unsigned char h,m,s; |
| volatile unsigned int I2CTimeout = 100; |
| volatile int MesswertNick,MesswertRoll,MesswertGier; |
| volatile int AdNeutralNick = 0,AdNeutralRoll = 0,AdNeutralGier = 0,StartNeutralRoll = 0,StartNeutralNick = 0; |
| volatile int Mittelwert_AccNick, Mittelwert_AccRoll,Mittelwert_AccHoch, NeutralAccX=0, NeutralAccY=0; |
| volatile float NeutralAccZ = 0; |
| unsigned char CosinusNickWinkel = 0, CosinusRollWinkel = 0; |
| volatile long IntegralNick = 0,IntegralNick2 = 0; |
| volatile long IntegralRoll = 0,IntegralRoll2 = 0; |
| volatile long IntegralAccNick = 0,IntegralAccRoll = 0,IntegralAccZ = 0; |
| volatile long Integral_Gier = 0; |
| volatile long Mess_IntegralNick = 0,Mess_IntegralNick2 = 0; |
| volatile long Mess_IntegralRoll = 0,Mess_IntegralRoll2 = 0; |
| volatile long Mess_Integral_Gier = 0,Mess_Integral_Gier2 = 0; |
| volatile long MittelIntegralNick,MittelIntegralRoll,MittelIntegralNick2,MittelIntegralRoll2; |
| volatile long Mess_Integral_Hoch = 0; |
| volatile int KompassValue = 0; |
| volatile int KompassStartwert = 0; |
| volatile int KompassRichtung = 0; |
| unsigned char MAX_GAS,MIN_GAS; |
| unsigned char Notlandung = 0; |
| unsigned char HoehenReglerAktiv = 0; |
| long Umschlag180Nick = 250000L, Umschlag180Roll = 250000L; |
| //Salvo 12.10.2007 |
| uint8_t magkompass_ok=0; |
| uint8_t gps_cmd = GPS_CMD_STOP; |
| static int ubat_cnt =0; |
| static int gas_actual,gas_mittel; //Parameter fuer Gasreduzierung bei unterspannung |
| int w,v; |
| //Salvo End |
| //Salvo 15.12.2007 Ersatzkompass und Giergyrokompensation |
| long GyroKomp_Int; |
| long int GyroGier_Comp; |
| int GyroKomp_Value; // Der ermittelte Kompasswert aus Gyro und Magnetkompass |
| short int cnt_stickgier_zero =0; |
| int gyrogier_kompass; |
| // Salvo End |
| float GyroFaktor; |
| float IntegralFaktor; |
| volatile int DiffNick,DiffRoll; |
| int Poti1 = 0, Poti2 = 0, Poti3 = 0, Poti4 = 0; |
| volatile unsigned char Motor_Vorne,Motor_Hinten,Motor_Rechts,Motor_Links, Count; |
| unsigned char MotorWert[5]; |
| volatile unsigned char SenderOkay = 0; |
| int StickNick = 0,StickRoll = 0,StickGier = 0; |
| char MotorenEin = 0; |
| int HoehenWert = 0; |
| int SollHoehe = 0; |
| int LageKorrekturRoll = 0,LageKorrekturNick = 0; |
| float Ki = FAKTOR_I; |
| unsigned char Looping_Nick = 0,Looping_Roll = 0; |
| unsigned char Looping_Links = 0, Looping_Rechts = 0, Looping_Unten = 0, Looping_Oben = 0; |
| unsigned char Parameter_Luftdruck_D = 48; // Wert : 0-250 |
| unsigned char Parameter_MaxHoehe = 251; // Wert : 0-250 |
| unsigned char Parameter_Hoehe_P = 16; // Wert : 0-32 |
| unsigned char Parameter_Hoehe_ACC_Wirkung = 58; // Wert : 0-250 |
| unsigned char Parameter_KompassWirkung = 64; // Wert : 0-250 |
| unsigned char Parameter_Gyro_P = 150; // Wert : 10-250 |
| unsigned char Parameter_Gyro_I = 150; // Wert : 0-250 |
| unsigned char Parameter_Gier_P = 2; // Wert : 1-20 |
| unsigned char Parameter_I_Faktor = 10; // Wert : 1-20 |
| unsigned char Parameter_UserParam1 = 0; |
| unsigned char Parameter_UserParam2 = 0; |
| unsigned char Parameter_UserParam3 = 0; |
| unsigned char Parameter_UserParam4 = 0; |
| unsigned char Parameter_UserParam5 = 0; |
| unsigned char Parameter_UserParam6 = 0; |
| unsigned char Parameter_UserParam7 = 0; |
| unsigned char Parameter_UserParam8 = 0; |
| unsigned char Parameter_ServoNickControl = 100; |
| unsigned char Parameter_LoopGasLimit = 70; |
| unsigned char Parameter_AchsKopplung1 = 0; |
| unsigned char Parameter_AchsGegenKopplung1 = 0; |
| unsigned char Parameter_DynamicStability = 100; |
| struct mk_param_struct EE_Parameter; |
| signed int ExternStickNick = 0,ExternStickRoll = 0,ExternStickGier = 0, ExternHoehenValue = -20; |
| void Piep(unsigned char Anzahl) |
| { |
| while(Anzahl--) |
| { |
| if(MotorenEin) return; //auf keinen Fall im Flug! |
| beeptime = 100; |
| Delay_ms(250); |
| } |
| } |
| //############################################################################ |
| // Nullwerte ermitteln |
| void SetNeutral(void) |
| //############################################################################ |
| { |
| // Salvo 9.12.2007 |
| RX_SWTCH_ON; //GPS Daten auf RX eingang schalten |
| // Salvo End |
| NeutralAccX = 0; |
| NeutralAccY = 0; |
| NeutralAccZ = 0; |
| AdNeutralNick = 0; |
| AdNeutralRoll = 0; |
| AdNeutralGier = 0; |
| Parameter_AchsKopplung1 = 0; |
| Parameter_AchsGegenKopplung1 = 0; |
| CalibrierMittelwert(); |
| Delay_ms_Mess(100); |
| CalibrierMittelwert(); |
| if((EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)) // Höhenregelung aktiviert? |
| { |
| if((MessLuftdruck > 950) || (MessLuftdruck < 750)) SucheLuftruckOffset(); |
| } |
| AdNeutralNick= AdWertNick; |
| AdNeutralRoll= AdWertRoll; |
| AdNeutralGier= AdWertGier; |
| StartNeutralRoll = AdNeutralRoll; |
| StartNeutralNick = AdNeutralNick; |
| if(eeprom_read_byte(&EEPromArray[EEPROM_ADR_ACC_NICK]) > 4) |
| { |
| NeutralAccY = abs(Mittelwert_AccRoll) / ACC_AMPLIFY; |
| NeutralAccX = abs(Mittelwert_AccNick) / ACC_AMPLIFY; |
| NeutralAccZ = Aktuell_az; |
| } |
| else |
| { |
| NeutralAccX = (int)eeprom_read_byte(&EEPromArray[EEPROM_ADR_ACC_NICK]) * 256 + (int)eeprom_read_byte(&EEPromArray[EEPROM_ADR_ACC_NICK+1]); |
| NeutralAccY = (int)eeprom_read_byte(&EEPromArray[EEPROM_ADR_ACC_ROLL]) * 256 + (int)eeprom_read_byte(&EEPromArray[EEPROM_ADR_ACC_ROLL+1]); |
| NeutralAccZ = (int)eeprom_read_byte(&EEPromArray[EEPROM_ADR_ACC_Z]) * 256 + (int)eeprom_read_byte(&EEPromArray[EEPROM_ADR_ACC_Z+1]); |
| } |
| Mess_IntegralNick = 0; |
| Mess_IntegralNick2 = 0; |
| Mess_IntegralRoll = 0; |
| Mess_IntegralRoll2 = 0; |
| Mess_Integral_Gier = 0; |
| MesswertNick = 0; |
| MesswertRoll = 0; |
| MesswertGier = 0; |
| GyroGier_Comp =0; |
| StartLuftdruck = Luftdruck; |
| HoeheD = 0; |
| Mess_Integral_Hoch = 0; |
| KompassStartwert = KompassValue; |
| GPS_Neutral(); |
| beeptime = 50; |
| Umschlag180Nick = (long) EE_Parameter.WinkelUmschlagNick * 2500L; |
| Umschlag180Roll = (long) EE_Parameter.WinkelUmschlagRoll * 2500L; |
| ExternHoehenValue = 0; |
| //Salvo 13.10.2007 Ersatzkompass und Gas |
| GyroKomp_Int = KompassValue * GYROKOMP_INC_GRAD_DEFAULT; //Neu ab 3.1.2007 |
| gas_mittel = 30; |
| gas_actual = gas_mittel; |
| // Salvo End |
| } |
| //############################################################################ |
| // Bearbeitet die Messwerte |
| void Mittelwert(void) |
| //############################################################################ |
| { |
| static signed long tmpl,tmpl2; |
| MesswertGier = (signed int) AdNeutralGier - AdWertGier; |
| MesswertRoll = (signed int) AdWertRoll - AdNeutralRoll; |
| MesswertNick = (signed int) AdWertNick - AdNeutralNick; |
| // Beschleunigungssensor ++++++++++++++++++++++++++++++++++++++++++++++++ |
| Mittelwert_AccNick = ((long)Mittelwert_AccNick * 1 + ((ACC_AMPLIFY * (long)AdWertAccNick))) / 2L; |
| Mittelwert_AccRoll = ((long)Mittelwert_AccRoll * 1 + ((ACC_AMPLIFY * (long)AdWertAccRoll))) / 2L; |
| Mittelwert_AccHoch = ((long)Mittelwert_AccHoch * 1 + ((long)AdWertAccHoch)) / 2L; |
| IntegralAccNick += ACC_AMPLIFY * AdWertAccNick; |
| IntegralAccRoll += ACC_AMPLIFY * AdWertAccRoll; |
| IntegralAccZ += Aktuell_az - NeutralAccZ; |
| // Gier ++++++++++++++++++++++++++++++++++++++++++++++++ |
| //Salvo 12.11.2007 |
| GyroKomp_Int += (long)MesswertGier; |
| GyroGier_Comp += (long)MesswertGier; |
| //Salvo End |
| Mess_Integral_Gier += MesswertGier; |
| Mess_Integral_Gier2 += MesswertGier; |
| // Kopplungsanteil +++++++++++++++++++++++++++++++++++++ |
| if(!Looping_Nick && !Looping_Roll && (EE_Parameter.GlobalConfig & CFG_ACHSENKOPPLUNG_AKTIV)) |
| { |
| tmpl = Mess_IntegralNick / 4096L; |
| tmpl *= MesswertGier; |
| tmpl *= Parameter_AchsKopplung1; //125 |
| tmpl /= 2048L; |
| tmpl2 = Mess_IntegralRoll / 4096L; |
| tmpl2 *= MesswertGier; |
| tmpl2 *= Parameter_AchsKopplung1; |
| tmpl2 /= 2048L; |
| } |
| else tmpl = tmpl2 = 0; |
| // Roll ++++++++++++++++++++++++++++++++++++++++++++++++ |
| MesswertRoll += tmpl; |
| MesswertRoll += (tmpl2*Parameter_AchsGegenKopplung1)/512L; //109 |
| Mess_IntegralRoll2 += MesswertRoll; |
| Mess_IntegralRoll += MesswertRoll - LageKorrekturRoll; |
| if(Mess_IntegralRoll > Umschlag180Roll) |
| { |
| Mess_IntegralRoll = -(Umschlag180Roll - 10000L); |
| Mess_IntegralRoll2 = Mess_IntegralRoll; |
| } |
| if(Mess_IntegralRoll <-Umschlag180Roll) |
| { |
| Mess_IntegralRoll = (Umschlag180Roll - 10000L); |
| Mess_IntegralRoll2 = Mess_IntegralRoll; |
| } |
| if(AdWertRoll < 15) MesswertRoll = -1000; |
| if(AdWertRoll < 7) MesswertRoll = -2000; |
| if(PlatinenVersion == 10) |
| { |
| if(AdWertRoll > 1010) MesswertRoll = +1000; |
| if(AdWertRoll > 1017) MesswertRoll = +2000; |
| } |
| else |
| { |
| if(AdWertRoll > 2020) MesswertRoll = +1000; |
| if(AdWertRoll > 2034) MesswertRoll = +2000; |
| } |
| // Nick ++++++++++++++++++++++++++++++++++++++++++++++++ |
| MesswertNick -= tmpl2; |
| MesswertNick -= (tmpl*Parameter_AchsGegenKopplung1)/512L; |
| Mess_IntegralNick2 += MesswertNick; |
| Mess_IntegralNick += MesswertNick - LageKorrekturNick; |
| if(Mess_IntegralNick > Umschlag180Nick) |
| { |
| Mess_IntegralNick = -(Umschlag180Nick - 10000L); |
| Mess_IntegralNick2 = Mess_IntegralNick; |
| } |
| if(Mess_IntegralNick <-Umschlag180Nick) |
| { |
| Mess_IntegralNick = (Umschlag180Nick - 10000L); |
| Mess_IntegralNick2 = Mess_IntegralNick; |
| } |
| if(AdWertNick < 15) MesswertNick = -1000; |
| if(AdWertNick < 7) MesswertNick = -2000; |
| if(PlatinenVersion == 10) |
| { |
| if(AdWertNick > 1010) MesswertNick = +1000; |
| if(AdWertNick > 1017) MesswertNick = +2000; |
| } |
| else |
| { |
| if(AdWertNick > 2020) MesswertNick = +1000; |
| if(AdWertNick > 2034) MesswertNick = +2000; |
| } |
| //++++++++++++++++++++++++++++++++++++++++++++++++ |
| // ADC einschalten |
| ANALOG_ON; |
| //++++++++++++++++++++++++++++++++++++++++++++++++ |
| Integral_Gier = Mess_Integral_Gier; |
| IntegralNick = Mess_IntegralNick; |
| IntegralRoll = Mess_IntegralRoll; |
| IntegralNick2 = Mess_IntegralNick2; |
| IntegralRoll2 = Mess_IntegralRoll2; |
| if(EE_Parameter.GlobalConfig & CFG_DREHRATEN_BEGRENZER && !Looping_Nick && !Looping_Roll) |
| { |
| if(MesswertNick > 200) MesswertNick += 4 * (MesswertNick - 200); |
| else if(MesswertNick < -200) MesswertNick += 4 * (MesswertNick + 200); |
| if(MesswertRoll > 200) MesswertRoll += 4 * (MesswertRoll - 200); |
| else if(MesswertRoll < -200) MesswertRoll += 4 * (MesswertRoll + 200); |
| } |
| if(Poti1 < PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]] + 110) Poti1++; else if(Poti1 > PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]] + 110 && Poti1) Poti1--; |
| if(Poti2 < PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]] + 110) Poti2++; else if(Poti2 > PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]] + 110 && Poti2) Poti2--; |
| if(Poti3 < PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]] + 110) Poti3++; else if(Poti3 > PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]] + 110 && Poti3) Poti3--; |
| if(Poti4 < PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]] + 110) Poti4++; else if(Poti4 > PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]] + 110 && Poti4) Poti4--; |
| if(Poti1 < 0) Poti1 = 0; else if(Poti1 > 255) Poti1 = 255; |
| if(Poti2 < 0) Poti2 = 0; else if(Poti2 > 255) Poti2 = 255; |
| if(Poti3 < 0) Poti3 = 0; else if(Poti3 > 255) Poti3 = 255; |
| if(Poti4 < 0) Poti4 = 0; else if(Poti4 > 255) Poti4 = 255; |
| } |
| //############################################################################ |
| // Messwerte beim Ermitteln der Nullage |
| void CalibrierMittelwert(void) |
| //############################################################################ |
| { |
| // ADC auschalten, damit die Werte sich nicht während der Berechnung ändern |
| ANALOG_OFF; |
| MesswertNick = AdWertNick; |
| MesswertRoll = AdWertRoll; |
| MesswertGier = AdWertGier; |
| Mittelwert_AccNick = ACC_AMPLIFY * (long)AdWertAccNick; |
| Mittelwert_AccRoll = ACC_AMPLIFY * (long)AdWertAccRoll; |
| Mittelwert_AccHoch = (long)AdWertAccHoch; |
| // ADC einschalten |
| ANALOG_ON; |
| if(Poti1 < PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]] + 110) Poti1++; else if(Poti1 > PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]] + 110 && Poti1) Poti1--; |
| if(Poti2 < PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]] + 110) Poti2++; else if(Poti2 > PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]] + 110 && Poti2) Poti2--; |
| if(Poti3 < PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]] + 110) Poti3++; else if(Poti3 > PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]] + 110 && Poti3) Poti3--; |
| if(Poti4 < PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]] + 110) Poti4++; else if(Poti4 > PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]] + 110 && Poti4) Poti4--; |
| if(Poti1 < 0) Poti1 = 0; else if(Poti1 > 255) Poti1 = 255; |
| if(Poti2 < 0) Poti2 = 0; else if(Poti2 > 255) Poti2 = 255; |
| if(Poti3 < 0) Poti3 = 0; else if(Poti3 > 255) Poti3 = 255; |
| if(Poti4 < 0) Poti4 = 0; else if(Poti4 > 255) Poti4 = 255; |
| Umschlag180Nick = (long) EE_Parameter.WinkelUmschlagNick * 2500L; |
| Umschlag180Roll = (long) EE_Parameter.WinkelUmschlagNick * 2500L; |
| } |
| //############################################################################ |
| // Senden der Motorwerte per I2C-Bus |
| void SendMotorData(void) |
| //############################################################################ |
| { |
| if(MOTOR_OFF || !MotorenEin) |
| { |
| Motor_Hinten = 0; |
| Motor_Vorne = 0; |
| Motor_Rechts = 0; |
| Motor_Links = 0; |
| if(MotorTest[0]) Motor_Vorne = MotorTest[0]; |
| if(MotorTest[1]) Motor_Hinten = MotorTest[1]; |
| if(MotorTest[2]) Motor_Links = MotorTest[2]; |
| if(MotorTest[3]) Motor_Rechts = MotorTest[3]; |
| } |
| DebugOut.Analog[12] = Motor_Vorne; |
| DebugOut.Analog[13] = Motor_Hinten; |
| DebugOut.Analog[14] = Motor_Links; |
| DebugOut.Analog[15] = Motor_Rechts; |
| //Start I2C Interrupt Mode |
| twi_state = 0; |
| motor = 0; |
| i2c_start(); |
| } |
| //############################################################################ |
| // Trägt ggf. das Poti als Parameter ein |
| void ParameterZuordnung(void) |
| //############################################################################ |
| { |
| #define CHK_POTI(b,a,min,max) { if(a > 250) { if(a == 251) b = Poti1; else if(a == 252) b = Poti2; else if(a == 253) b = Poti3; else if(a == 254) b = Poti4;} else b = a; if(b <= min) b = min; else if(b >= max) b = max;} |
| CHK_POTI(Parameter_MaxHoehe,EE_Parameter.MaxHoehe,0,255); |
| CHK_POTI(Parameter_Luftdruck_D,EE_Parameter.Luftdruck_D,0,100); |
| CHK_POTI(Parameter_Hoehe_P,EE_Parameter.Hoehe_P,0,100); |
| CHK_POTI(Parameter_Hoehe_ACC_Wirkung,EE_Parameter.Hoehe_ACC_Wirkung,0,255); |
| CHK_POTI(Parameter_KompassWirkung,EE_Parameter.KompassWirkung,0,255); |
| CHK_POTI(Parameter_Gyro_P,EE_Parameter.Gyro_P,10,255); |
| CHK_POTI(Parameter_Gyro_I,EE_Parameter.Gyro_I,0,255); |
| CHK_POTI(Parameter_I_Faktor,EE_Parameter.I_Faktor,0,255); |
| CHK_POTI(Parameter_UserParam1,EE_Parameter.UserParam1,0,255); |
| CHK_POTI(Parameter_UserParam2,EE_Parameter.UserParam2,0,255); |
| CHK_POTI(Parameter_UserParam3,EE_Parameter.UserParam3,0,255); |
| CHK_POTI(Parameter_UserParam4,EE_Parameter.UserParam4,0,255); |
| CHK_POTI(Parameter_UserParam5,EE_Parameter.UserParam5,0,255); |
| CHK_POTI(Parameter_UserParam6,EE_Parameter.UserParam6,0,255); |
| CHK_POTI(Parameter_UserParam7,EE_Parameter.UserParam7,0,255); |
| CHK_POTI(Parameter_UserParam8,EE_Parameter.UserParam8,0,255); |
| CHK_POTI(Parameter_ServoNickControl,EE_Parameter.ServoNickControl,0,255); |
| CHK_POTI(Parameter_LoopGasLimit,EE_Parameter.LoopGasLimit,0,255); |
| CHK_POTI(Parameter_AchsKopplung1, EE_Parameter.AchsKopplung1,0,255); |
| CHK_POTI(Parameter_AchsGegenKopplung1,EE_Parameter.AchsGegenKopplung1,0,255); |
| CHK_POTI(Parameter_DynamicStability,EE_Parameter.DynamicStability,0,255); |
| Ki = (float) Parameter_I_Faktor * 0.0001; |
| MAX_GAS = EE_Parameter.Gas_Max; |
| MIN_GAS = EE_Parameter.Gas_Min; |
| } |
| //############################################################################ |
| // |
| void MotorRegler(void) |
| //############################################################################ |
| { |
| int motorwert,pd_ergebnis,h,tmp_int; |
| int GierMischanteil,GasMischanteil; |
| static long SummeNick=0,SummeRoll=0; |
| static long sollGier = 0,tmp_long,tmp_long2; |
| static long IntegralFehlerNick = 0; |
| static long IntegralFehlerRoll = 0; |
| static unsigned int RcLostTimer; |
| static unsigned char delay_neutral = 0; |
| static unsigned char delay_einschalten = 0,delay_ausschalten = 0; |
| static unsigned int modell_fliegt = 0; |
| static int hoehenregler = 0; |
| static char TimerWerteausgabe = 0; |
| static char NeueKompassRichtungMerken = 0; |
| static long ausgleichNick, ausgleichRoll; |
| Mittelwert(); |
| //****** GPS Daten holen *************** |
| short int n; |
| if (gps_alive_cnt > 0) gps_alive_cnt--; //Dekrementieren. Wenn 0 kommen keine ausreichenden GPS Meldungen (Timeout) |
| n = Get_Rel_Position(); |
| if (n == 0) |
| { |
| ROT_ON; //led blitzen lassen |
| } |
| //******PROVISORISCH*************** |
| GRN_ON; |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Gaswert ermitteln |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| GasMischanteil = PPM_in[EE_Parameter.Kanalbelegung[K_GAS]] + 120; |
| if(GasMischanteil > MAX_GAS - 20) GasMischanteil = MAX_GAS - 20; |
| //Salvo 13.10.2007 langsame Gasreduktion bei Unterspannung. Als Ausgangswert wird der bei UBAT=k gemessen Mittelwert genommen |
| // und dieser dann langsam zwangsweise reduziert |
| if (UBat <= EE_Parameter.UnterspannungsWarnung - 2) //Unterhalb der Piepser Schwelle aktivieren |
| { |
| if (ubat_cnt > 700) |
| { |
| ubat_cnt = 0; |
| if (gas_actual > ((gas_mittel*12)/15)) gas_actual--; |
| } |
| else ubat_cnt++; |
| if (GasMischanteil > gas_actual) GasMischanteil = gas_actual; |
| } |
| else //Falls UBAT wieder ok ist |
| { |
| if (ubat_cnt > 1000) |
| { |
| gas_mittel = ((gas_mittel*9) + GasMischanteil)/10; //Filtern |
| gas_actual = GasMischanteil; |
| } |
| else |
| { |
| ubat_cnt++; |
| if ((ubat_cnt % 10) == 0) |
| { |
| if (gas_actual < GasMischanteil) gas_actual++; |
| else gas_actual = GasMischanteil; |
| } |
| } |
| GasMischanteil = gas_actual; |
| } |
| // Salvo End |
| if(GasMischanteil < 0) GasMischanteil = 0; |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Empfang schlecht |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| if(SenderOkay < 100) |
| { |
| if(!PcZugriff) |
| { |
| if(BeepMuster == 0xffff) |
| { |
| beeptime = 15000; |
| BeepMuster = 0x0c00; |
| } |
| } |
| if(RcLostTimer) RcLostTimer--; |
| else |
| { |
| MotorenEin = 0; |
| Notlandung = 0; |
| } |
| ROT_ON; |
| if(modell_fliegt > 2000) // wahrscheinlich in der Luft --> langsam absenken |
| { |
| GasMischanteil = EE_Parameter.NotGas; |
| Notlandung = 1; |
| PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] = 0; |
| PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] = 0; |
| PPM_in[EE_Parameter.Kanalbelegung[K_GIER]] = 0; |
| } |
| else MotorenEin = 0; |
| } |
| else |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Emfang gut |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| if(SenderOkay > 140) |
| { |
| Notlandung = 0; |
| RcLostTimer = EE_Parameter.NotGasZeit * 50; |
| if(GasMischanteil > 40) |
| { |
| if(modell_fliegt < 0xffff) modell_fliegt++; |
| } |
| if((modell_fliegt < 200) || (GasMischanteil < 40)) |
| { |
| SummeNick = 0; |
| SummeRoll = 0; |
| Mess_Integral_Gier = 0; |
| Mess_Integral_Gier2 = 0; |
| } |
| if((GasMischanteil > 200) && MotorenEin == 0) |
| { |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // auf Nullwerte kalibrieren |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| if(PPM_in[EE_Parameter.Kanalbelegung[K_GIER]] > 75) // Neutralwerte |
| { |
| if(++delay_neutral > 200) // nicht sofort |
| { |
| GRN_OFF; |
| SetNeutral(); |
| MotorenEin = 0; |
| delay_neutral = 0; |
| modell_fliegt = 0; |
| if(PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70 || abs(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]) > 70) |
| { |
| unsigned char setting=1; |
| if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] > 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < 70) setting = 1; |
| if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] > 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70) setting = 2; |
| if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] < 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70) setting = 3; |
| if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] <-70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70) setting = 4; |
| if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] <-70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < 70) setting = 5; |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACTIVE_SET], setting); // aktiven Datensatz merken |
| } |
| ReadParameterSet(GetActiveParamSetNumber(), (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE); |
| Piep(GetActiveParamSetNumber()); |
| if((EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)) // Höhenregelung aktiviert? |
| { |
| if((MessLuftdruck > 950) || (MessLuftdruck < 750)) SucheLuftruckOffset(); |
| } |
| GPS_Save_Home(); //Daten sind jetzt hoffentlich verfuegbar |
| if (gps_home_position.status > 0 ) |
| { |
| Delay_ms(1000); //akustisch verkuenden dass GPS Home Daten da sind |
| beeptime = 2000; |
| Delay_ms(500); |
| } |
| } |
| } |
| else |
| if(PPM_in[EE_Parameter.Kanalbelegung[K_GIER]] < -75) // ACC Neutralwerte speichern |
| { |
| if(++delay_neutral > 200) // nicht sofort |
| { |
| GRN_OFF; |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACC_NICK],0xff); // Werte löschen |
| MotorenEin = 0; |
| delay_neutral = 0; |
| modell_fliegt = 0; |
| SetNeutral(); |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACC_NICK],NeutralAccX / 256); // ACC-NeutralWerte speichern |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACC_NICK+1],NeutralAccX % 256); // ACC-NeutralWerte speichern |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACC_ROLL],NeutralAccY / 256); |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACC_ROLL+1],NeutralAccY % 256); |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACC_Z],(int)NeutralAccZ / 256); |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACC_Z+1],(int)NeutralAccZ % 256); |
| Piep(GetActiveParamSetNumber()); |
| } |
| } |
| else delay_neutral = 0; |
| } |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Gas ist unten |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| if(GasMischanteil < 35) |
| { |
| // Starten |
| if(PPM_in[EE_Parameter.Kanalbelegung[K_GIER]] < -75) |
| { |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Einschalten |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| if(++delay_einschalten > 200) |
| { |
| int n; |
| // Salvo 9.12.2007 |
| RX_SWTCH_ON; //GPS Daten auf RX eingang schalten |
| // Salvo End |
| delay_einschalten = 200; |
| modell_fliegt = 1; |
| MotorenEin = 1; |
| sollGier = 0; |
| Mess_Integral_Gier = 0; |
| Mess_Integral_Gier2 = 0; |
| Mess_IntegralNick = 0; |
| Mess_IntegralRoll = 0; |
| Mess_IntegralNick2 = IntegralNick; |
| Mess_IntegralRoll2 = IntegralRoll; |
| SummeNick = 0; |
| SummeRoll = 0; |
| n= GPS_CRTL(GPS_CMD_STOP); //GPS Lageregelung beenden |
| } |
| } |
| else delay_einschalten = 0; |
| //Auf Neutralwerte setzen |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Auschalten |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| if(PPM_in[EE_Parameter.Kanalbelegung[K_GIER]] > 75) |
| { |
| if(++delay_ausschalten > 200) // nicht sofort |
| { |
| // Salvo 9.12.2007 |
| RX_SWTCH_OFF; //Bluetooth Daten auf RX eingang schalten |
| // Salvo End |
| MotorenEin = 0; |
| delay_ausschalten = 200; |
| modell_fliegt = 0; |
| } |
| } |
| else delay_ausschalten = 0; |
| } |
| } |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // neue Werte von der Funke |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| if(!NewPpmData-- || Notlandung) |
| { |
| int tmp_int; |
| ParameterZuordnung(); |
| StickNick = PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] * EE_Parameter.Stick_P; |
| StickNick += PPM_diff[EE_Parameter.Kanalbelegung[K_NICK]] * EE_Parameter.Stick_D; |
| StickRoll = PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] * EE_Parameter.Stick_P; |
| StickRoll += PPM_diff[EE_Parameter.Kanalbelegung[K_ROLL]] * EE_Parameter.Stick_D; |
| StickGier = -PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]; |
| GyroFaktor = ((float)Parameter_Gyro_P + 10.0) / 256.0; |
| IntegralFaktor = ((float) Parameter_Gyro_I) / 44000; |
| #define KEY_VALUE (Parameter_UserParam1 * 4) //(Poti3 * 8) |
| if(DubWiseKeys[1]) beeptime = 10; |
| if(DubWiseKeys[1] & DUB_KEY_UP) tmp_int = KEY_VALUE; else |
| if(DubWiseKeys[1] & DUB_KEY_DOWN) tmp_int = -KEY_VALUE; else tmp_int = 0; |
| ExternStickNick = (ExternStickNick * 7 + tmp_int) / 8; |
| if(DubWiseKeys[1] & DUB_KEY_LEFT) tmp_int = KEY_VALUE; else |
| if(DubWiseKeys[1] & DUB_KEY_RIGHT) tmp_int = -KEY_VALUE; else tmp_int = 0; |
| ExternStickRoll = (ExternStickRoll * 7 + tmp_int) / 8; |
| if(DubWiseKeys[0] & 8) ExternStickGier = 50;else |
| if(DubWiseKeys[0] & 4) ExternStickGier =-50;else ExternStickGier = 0; |
| if(DubWiseKeys[0] & 2) ExternHoehenValue++; |
| if(DubWiseKeys[0] & 16) ExternHoehenValue--; |
| StickNick += ExternStickNick / 8; |
| StickRoll += ExternStickRoll / 8; |
| StickGier += ExternStickGier; |
| if(EE_Parameter.GlobalConfig & CFG_HEADING_HOLD) IntegralFaktor = 0; |
| if(GyroFaktor < 0) GyroFaktor = 0; |
| if(IntegralFaktor < 0) IntegralFaktor = 0; |
| // greift in den Stick ein, um ungewolltes überschlagen zu verhindern |
| if(!(EE_Parameter.LoopConfig & CFG_LOOP_LINKS) && !(EE_Parameter.LoopConfig & CFG_LOOP_RECHTS)) |
| { |
| if(IntegralNick > 60000) |
| { |
| StickNick -= 8 * EE_Parameter.Stick_P; |
| if(IntegralNick > 80000) StickNick -= 16 * EE_Parameter.Stick_P; |
| } |
| else |
| if(IntegralNick < -60000) |
| { |
| StickNick += 8 * EE_Parameter.Stick_P; |
| if(IntegralNick > 80000) StickNick -= 16 * EE_Parameter.Stick_P; |
| } |
| if(IntegralRoll > 60000) |
| { |
| StickRoll -= 8 * EE_Parameter.Stick_P; |
| if(IntegralRoll > 80000) StickRoll -= 16 * EE_Parameter.Stick_P; |
| } |
| else |
| if(IntegralRoll < -60000) |
| { |
| StickRoll += 8 * EE_Parameter.Stick_P; |
| if(IntegralRoll > 80000) StickRoll -= 16 * EE_Parameter.Stick_P; |
| } |
| } |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Looping? |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| if((PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] > EE_Parameter.LoopThreshold) && EE_Parameter.LoopConfig & CFG_LOOP_LINKS) Looping_Links = 1; |
| else |
| { |
| { |
| if((PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] < (EE_Parameter.LoopThreshold - EE_Parameter.LoopHysterese))) Looping_Links = 0; |
| } |
| } |
| if((PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] < -EE_Parameter.LoopThreshold) && EE_Parameter.LoopConfig & CFG_LOOP_RECHTS) Looping_Rechts = 1; |
| else |
| { |
| if(Looping_Rechts) // Hysterese |
| { |
| if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] > -(EE_Parameter.LoopThreshold - EE_Parameter.LoopHysterese)) Looping_Rechts = 0; |
| } |
| } |
| if((PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > EE_Parameter.LoopThreshold) && EE_Parameter.LoopConfig & CFG_LOOP_OBEN) Looping_Oben = 1; |
| else |
| { |
| if(Looping_Oben) // Hysterese |
| { |
| if((PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < (EE_Parameter.LoopThreshold - EE_Parameter.LoopHysterese))) Looping_Oben = 0; |
| } |
| } |
| if((PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < -EE_Parameter.LoopThreshold) && EE_Parameter.LoopConfig & CFG_LOOP_UNTEN) Looping_Unten = 1; |
| else |
| { |
| if(Looping_Unten) // Hysterese |
| { |
| if(PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > -(EE_Parameter.LoopThreshold - EE_Parameter.LoopHysterese)) Looping_Unten = 0; |
| } |
| } |
| if(Looping_Links || Looping_Rechts) Looping_Roll = 1; else Looping_Roll = 0; |
| if(Looping_Oben || Looping_Unten) {Looping_Nick = 1; Looping_Roll = 0; Looping_Links = 0; Looping_Rechts = 0;} else Looping_Nick = 0; |
| } // Ende neue Funken-Werte |
| if(Looping_Roll) beeptime = 100; |
| if(Looping_Roll || Looping_Nick) |
| { |
| if(GasMischanteil > EE_Parameter.LoopGasLimit) GasMischanteil = EE_Parameter.LoopGasLimit; |
| } |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Bei Empfangsausfall im Flug |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| if(Notlandung) |
| { |
| StickGier = 0; |
| StickNick = 0; |
| StickRoll = 0; |
| GyroFaktor = 0.1; |
| IntegralFaktor = 0.005; |
| Looping_Roll = 0; |
| Looping_Nick = 0; |
| } |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Integrale auf ACC-Signal abgleichen |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| #define ABGLEICH_ANZAHL 256L |
| MittelIntegralNick += IntegralNick; // Für die Mittelwertbildung aufsummieren |
| MittelIntegralRoll += IntegralRoll; |
| MittelIntegralNick2 += IntegralNick2; |
| MittelIntegralRoll2 += IntegralRoll2; |
| if(Looping_Nick || Looping_Roll) |
| { |
| IntegralAccNick = 0; |
| IntegralAccRoll = 0; |
| MittelIntegralNick = 0; |
| MittelIntegralRoll = 0; |
| MittelIntegralNick2 = 0; |
| MittelIntegralRoll2 = 0; |
| Mess_IntegralNick2 = Mess_IntegralNick; |
| Mess_IntegralRoll2 = Mess_IntegralRoll; |
| ZaehlMessungen = 0; |
| LageKorrekturNick = 0; |
| LageKorrekturRoll = 0; |
| } |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| if(!Looping_Nick && !Looping_Roll) |
| { |
| long tmp_long, tmp_long2; |
| tmp_long = (long)(IntegralNick / EE_Parameter.GyroAccFaktor - (long)Mittelwert_AccNick); |
| tmp_long /= 16; |
| tmp_long2 = (long)(IntegralRoll / EE_Parameter.GyroAccFaktor - (long)Mittelwert_AccRoll); |
| tmp_long2 /= 16; |
| #define AUSGLEICH 32 //(Parameter_UserParam1 / 2) |
| if(tmp_long > AUSGLEICH) tmp_long = AUSGLEICH; |
| if(tmp_long < -AUSGLEICH) tmp_long =-AUSGLEICH; |
| if(tmp_long2 > AUSGLEICH) tmp_long2 = AUSGLEICH; |
| if(tmp_long2 <-AUSGLEICH) tmp_long2 =-AUSGLEICH; |
| Mess_IntegralNick -= tmp_long; |
| Mess_IntegralRoll -= tmp_long2; |
| } |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| if(ZaehlMessungen >= ABGLEICH_ANZAHL) |
| { |
| static int cnt = 0; |
| static char last_n_p,last_n_n,last_r_p,last_r_n; |
| static long MittelIntegralNick_Alt,MittelIntegralRoll_Alt; |
| if(!Looping_Nick && !Looping_Roll) |
| { |
| MittelIntegralNick /= ABGLEICH_ANZAHL; |
| MittelIntegralRoll /= ABGLEICH_ANZAHL; |
| IntegralAccNick = (EE_Parameter.GyroAccFaktor * IntegralAccNick) / ABGLEICH_ANZAHL; |
| IntegralAccRoll = (EE_Parameter.GyroAccFaktor * IntegralAccRoll) / ABGLEICH_ANZAHL; |
| IntegralAccZ = IntegralAccZ / ABGLEICH_ANZAHL; |
| #define MAX_I 0//(Poti2/10) |
| // Nick ++++++++++++++++++++++++++++++++++++++++++++++++ |
| IntegralFehlerNick = (long)(MittelIntegralNick - (long)IntegralAccNick); |
| ausgleichNick = IntegralFehlerNick / EE_Parameter.GyroAccAbgleich; |
| LageKorrekturNick = ausgleichNick / ABGLEICH_ANZAHL; |
| // Roll ++++++++++++++++++++++++++++++++++++++++++++++++ |
| IntegralFehlerRoll = (long)(MittelIntegralRoll - (long)IntegralAccRoll); |
| ausgleichRoll = IntegralFehlerRoll / EE_Parameter.GyroAccAbgleich; |
| LageKorrekturRoll = ausgleichRoll / ABGLEICH_ANZAHL; |
| // Mess_IntegralNick -= ausgleichNick; |
| // Mess_IntegralRoll -= ausgleichRoll; |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Gyro-Drift ermitteln |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| MittelIntegralNick2 /= ABGLEICH_ANZAHL; |
| MittelIntegralRoll2 /= ABGLEICH_ANZAHL; |
| // tmp_long = (long)(MittelIntegralNick2 - (long)IntegralAccNick); |
| // tmp_long2 = (long)(MittelIntegralRoll2 - (long)IntegralAccRoll); |
| tmp_long = IntegralNick2 - IntegralNick; |
| tmp_long2 = IntegralRoll2 - IntegralRoll; |
| //DebugOut.Analog[25] = MittelIntegralRoll2 / 26; |
| IntegralFehlerNick = tmp_long; |
| IntegralFehlerRoll = tmp_long2; |
| Mess_IntegralNick2 -= IntegralFehlerNick; |
| Mess_IntegralRoll2 -= IntegralFehlerRoll; |
| // IntegralFehlerNick = (IntegralFehlerNick * 1 + tmp_long) / 2; |
| // IntegralFehlerRoll = (IntegralFehlerRoll * 1 + tmp_long2) / 2; |
| //Salvo Ersatzkompass Ueberlauf korrigieren |
| if (GyroKomp_Int >= ((long)360 * GYROKOMP_INC_GRAD_DEFAULT)) GyroKomp_Int = GyroKomp_Int - (GYROKOMP_INC_GRAD_DEFAULT *(long)360); //neu ab 3.11.2007 |
| if (GyroKomp_Int < 0) GyroKomp_Int = GyroKomp_Int + (GYROKOMP_INC_GRAD_DEFAULT *(long)360); //neu ab 3.11.2007 |
| ROT_OFF; |
| // Salvo End |
| /*DebugOut.Analog[17] = IntegralAccNick / 26; |
| DebugOut.Analog[18] = IntegralAccRoll / 26; |
| DebugOut.Analog[19] = IntegralFehlerNick;// / 26; |
| DebugOut.Analog[20] = IntegralFehlerRoll;// / 26; |
| DebugOut.Analog[21] = MittelIntegralNick / 26; |
| DebugOut.Analog[22] = MittelIntegralRoll / 26; |
| DebugOut.Analog[28] = ausgleichNick; |
| DebugOut.Analog[29] = ausgleichRoll; |
| DebugOut.Analog[30] = LageKorrekturRoll * 10; |
| */ |
| #define FEHLER_LIMIT (ABGLEICH_ANZAHL * 4) |
| #define FEHLER_LIMIT2 (ABGLEICH_ANZAHL * 16) |
| #define BEWEGUNGS_LIMIT 20000 |
| // Nick +++++++++++++++++++++++++++++++++++++++++++++++++ |
| cnt = 1;// + labs(IntegralFehlerNick) / 4096; |
| if(labs(MittelIntegralNick_Alt - MittelIntegralNick) < BEWEGUNGS_LIMIT) |
| { |
| if(IntegralFehlerNick > FEHLER_LIMIT2) |
| { |
| if(last_n_p) |
| { |
| cnt += labs(IntegralFehlerNick) / FEHLER_LIMIT2; |
| ausgleichNick = IntegralFehlerNick / 8; |
| if(ausgleichNick > 5000) ausgleichNick = 5000; |
| LageKorrekturNick += ausgleichNick / ABGLEICH_ANZAHL; |
| } |
| else last_n_p = 1; |
| } else last_n_p = 0; |
| if(IntegralFehlerNick < -FEHLER_LIMIT2) |
| { |
| if(last_n_n) |
| { |
| cnt += labs(IntegralFehlerNick) / FEHLER_LIMIT2; |
| ausgleichNick = IntegralFehlerNick / 8; |
| if(ausgleichNick < -5000) ausgleichNick = -5000; |
| LageKorrekturNick += ausgleichNick / ABGLEICH_ANZAHL; |
| } |
| else last_n_n = 1; |
| } else last_n_n = 0; |
| } else cnt = 0; |
| //Salvo 11.12.2007 |
| w = (abs(Mittelwert_AccNick)); |
| v = (abs(Mittelwert_AccRoll)); |
| if ((w < ACC_WAAGRECHT_LIMIT) && (v < ACC_WAAGRECHT_LIMIT)) // Gyro nur in wwagrechter Lage nachtrimmen |
| { |
| if(cnt > EE_Parameter.Driftkomp) cnt = EE_Parameter.Driftkomp; |
| if(IntegralFehlerNick > FEHLER_LIMIT) AdNeutralNick += cnt; |
| if(IntegralFehlerNick < -FEHLER_LIMIT) AdNeutralNick -= cnt; |
| } |
| //Salvo End |
| // Roll +++++++++++++++++++++++++++++++++++++++++++++++++ |
| cnt = 1;// + labs(IntegralFehlerNick) / 4096; |
| ausgleichRoll = 0; |
| if(labs(MittelIntegralRoll_Alt - MittelIntegralRoll) < BEWEGUNGS_LIMIT) |
| { |
| if(IntegralFehlerRoll > FEHLER_LIMIT2) |
| { |
| if(last_r_p) |
| { |
| cnt += labs(IntegralFehlerRoll) / FEHLER_LIMIT2; |
| ausgleichRoll = IntegralFehlerRoll / 8; |
| if(ausgleichRoll > 5000) ausgleichRoll = 5000; |
| LageKorrekturRoll += ausgleichRoll / ABGLEICH_ANZAHL; |
| } |
| else last_r_p = 1; |
| } else last_r_p = 0; |
| if(IntegralFehlerRoll < -FEHLER_LIMIT2) |
| { |
| if(last_r_n) |
| { |
| cnt += labs(IntegralFehlerRoll) / FEHLER_LIMIT2; |
| ausgleichRoll = IntegralFehlerRoll / 8; |
| if(ausgleichRoll < -5000) ausgleichRoll = -5000; |
| LageKorrekturRoll += ausgleichRoll / ABGLEICH_ANZAHL; |
| } |
| else last_r_n = 1; |
| } else last_r_n = 0; |
| } else |
| { |
| cnt = 0; |
| } |
| //Salvo 11.12.2007 |
| w = (abs(Mittelwert_AccNick)); |
| v = (abs(Mittelwert_AccRoll)); |
| if ((w < ACC_WAAGRECHT_LIMIT) && (v < ACC_WAAGRECHT_LIMIT)) // Gyro nur in wwagrechter Lage nachtrimmen |
| { |
| if(cnt > EE_Parameter.Driftkomp) cnt = EE_Parameter.Driftkomp; |
| if(IntegralFehlerRoll > FEHLER_LIMIT) AdNeutralRoll += cnt; |
| if(IntegralFehlerRoll < -FEHLER_LIMIT) AdNeutralRoll -= cnt; |
| } |
| //Salvo End |
| //DebugOut.Analog[23] = AdNeutralNick;//10*(AdNeutralNick - StartNeutralNick); |
| //DebugOut.Analog[24] = 10*(AdNeutralRoll - StartNeutralRoll); |
| } |
| else |
| { |
| LageKorrekturRoll = 0; |
| LageKorrekturNick = 0; |
| } |
| if(!IntegralFaktor) { LageKorrekturRoll = 0; LageKorrekturNick = 0;} // z.B. bei HH |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| MittelIntegralNick_Alt = MittelIntegralNick; |
| MittelIntegralRoll_Alt = MittelIntegralRoll; |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| IntegralAccNick = 0; |
| IntegralAccRoll = 0; |
| IntegralAccZ = 0; |
| MittelIntegralNick = 0; |
| MittelIntegralRoll = 0; |
| MittelIntegralNick2 = 0; |
| MittelIntegralRoll2 = 0; |
| ZaehlMessungen = 0; |
| } // Ende Abgleich |
| // Salvo Ersatzkompass und Giergyrokompensation 15.12.2007 ********************** |
| if ((Kompass_Neuer_Wert > 0)) |
| { |
| Kompass_Neuer_Wert = 0; |
| w = (abs(Mittelwert_AccNick)); |
| v = (abs(Mittelwert_AccRoll)); |
| if ((w < ACC_WAAGRECHT_LIMIT) && (v < ACC_WAAGRECHT_LIMIT)) //Ersatzkompass und Giergyro nur mit Magnetkompass aktualisieren wenn alles ok |
| { |
| if ((abs(KompassValue - Kompass_Value_Old)) <= 5) // Aufeinanderfolgende Werte duerfen nur minimal abweichen |
| { |
| if ((abs(StickGier) < 20)) //Giergyroabgleich mit Kompass |
| { |
| if (cnt_stickgier_zero < 255) cnt_stickgier_zero += 1; |
| if (cnt_stickgier_zero > 1) // nur Abgleichen wenn keine Stickbewegung da |
| { |
| w = (int) (GyroGier_Comp/(long)GYROKOMP_INC_GRAD_DEFAULT); |
| v = KompassValue - gyrogier_kompass; // realen Drehwinkel seit letztem Ruecksetzen von GyroGier_Comp bestimmen |
| if (v <-180) v +=360; // Uberlaufkorrektur |
| if (v > 180) v -=360; // Uberlaufkorrektur |
| v = w -v; //Differenz Gyro zu Kompass ist der Driftfehler |
| #define GIER_COMP_MAX 4 |
| if (v > GIER_COMP_MAX) v= GIER_COMP_MAX; |
| if (v < -GIER_COMP_MAX) v= - GIER_COMP_MAX; |
| if (abs(w) > 1) |
| { |
| GyroGier_Comp = 0; |
| gyrogier_kompass = KompassValue; // Kompasswert merken |
| AdNeutralGier -= v; |
| } |
| } |
| } |
| else |
| { |
| gyrogier_kompass = KompassValue; // Kompasswert merken |
| cnt_stickgier_zero = 0; |
| GyroGier_Comp = 0; |
| } |
| magkompass_ok = 1; // Flag dass Magnetkompass stabil arbeitet |
| GyroKomp_Int = (GyroKomp_Int )/(long)GYROKOMP_INC_GRAD_DEFAULT; |
| w = KompassValue - GyroKomp_Int; |
| if ((w > 0) && (w < 180)) |
| { |
| ++GyroKomp_Int; |
| } |
| else if ((w > 0) && (w >= 180)) |
| { |
| --GyroKomp_Int; |
| } |
| else if ((w < 0) && (w >= -180)) |
| { |
| --GyroKomp_Int; |
| } |
| else if ((w < 0) && (w < -180)) |
| { |
| ++GyroKomp_Int; |
| } |
| if (GyroKomp_Int < 0) GyroKomp_Int = GyroKomp_Int + 360L; |
| GyroKomp_Int = (GyroKomp_Int%360L) * (long)GYROKOMP_INC_GRAD_DEFAULT; // An Magnetkompasswert annaehern |
| } |
| } |
| else |
| { |
| magkompass_ok = 0; |
| GyroGier_Comp = 0; |
| } |
| Kompass_Value_Old = KompassValue; |
| } |
| // Salvo End ************************* |
| // Salvo 6.10.2007 |
| // GPS Home aktivieren wenn Knueppel in Ruhelage und Hoehenschalter aktiviert ist |
| //GPS Hold Aktiveren wenn Knueppel in Ruhelage sind |
| if ((EE_Parameter.GlobalConfig & CFG_GPS_AKTIV) && (abs(PPM_in[EE_Parameter.Kanalbelegung[K_NICK]]) < GPS_STICK_HOLDOFF) |
| && (abs(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]) < GPS_STICK_HOLDOFF) && (gps_alive_cnt > 0) && (GasMischanteil > 30)) |
| { |
| if (Parameter_MaxHoehe > 200) |
| { |
| if ( gps_cmd == GPS_CMD_REQ_HOLD) gps_cmd = GPS_CMD_STOP; // erst mal stoppen, denn altes Kommando wurde noch nicht beendet |
| else gps_cmd = GPS_CMD_REQ_HOME; |
| n = GPS_CRTL(gps_cmd); |
| } |
| else |
| { |
| if ( gps_cmd == GPS_CMD_REQ_HOME) gps_cmd = GPS_CMD_STOP; // erst mal stoppen, denn altes Kommando wurde noch nicht beendet |
| else gps_cmd = GPS_CMD_REQ_HOLD; |
| n= GPS_CRTL(gps_cmd); |
| } |
| } |
| else |
| { |
| if (gps_cmd != GPS_CMD_STOP) |
| { |
| gps_cmd = GPS_CMD_STOP; |
| n= GPS_CRTL(gps_cmd); //GPS Lageregelung beenden |
| } |
| } |
| if (gps_state != GPS_CRTL_IDLE) LED_J16_OFF; |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Gieren |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| if(abs(StickGier) > 20) // war 35 |
| { |
| if(!(EE_Parameter.GlobalConfig & CFG_KOMPASS_FIX)) NeueKompassRichtungMerken = 1; |
| } |
| tmp_int = (long) EE_Parameter.Gier_P * ((long)StickGier * abs(StickGier)) / 512L; // expo y = ax + bx² |
| tmp_int += (EE_Parameter.Gier_P * StickGier) / 4; |
| sollGier = tmp_int; |
| Mess_Integral_Gier -= tmp_int; |
| if(Mess_Integral_Gier > 50000) Mess_Integral_Gier = 50000; // begrenzen |
| if(Mess_Integral_Gier <-50000) Mess_Integral_Gier =-50000; |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Kompass |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| if(KompassValue && (EE_Parameter.GlobalConfig & CFG_KOMPASS_AKTIV) && (Kompass_present > 0)) |
| { |
| if(v > w) w = v; // grösste Neigung ermitteln |
| // Salvo 13.9.2007 Nur wenn Magnetkompass ordentliche Werte liefert |
| if ((magkompass_ok > 0) && NeueKompassRichtungMerken) |
| { |
| KompassStartwert = KompassValue; |
| NeueKompassRichtungMerken = 0; |
| } |
| // Salvo 13.9.2007 |
| w=0; |
| // Salvo End |
| w = (w * Parameter_KompassWirkung) / 64; // auf die Wirkung normieren |
| w = Parameter_KompassWirkung - w; // Wirkung ggf drosseln |
| if(w > 0) |
| { |
| // Salvo Kompasssteuerung ********************** |
| if (magkompass_ok > 0) Mess_Integral_Gier += (KompassRichtung * w) / 32; // nach Kompass ausrichten |
| // Salvo End |
| } |
| } |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Debugwerte zuordnen |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| if(!TimerWerteausgabe--) |
| { |
| TimerWerteausgabe = 24; |
| // Salvo 13.12.2007 Beleuchtung steuern |
| if (!(beeptime & BeepMuster)) LED_J16_FLASH; |
| else if (MotorenEin) LED_J16_ON; |
| else LED_J16_OFF; |
| // Salvo End |
| DebugOut.Analog[0] = IntegralNick / EE_Parameter.GyroAccFaktor; |
| DebugOut.Analog[1] = IntegralRoll / EE_Parameter.GyroAccFaktor; |
| DebugOut.Analog[2] = Mittelwert_AccNick; |
| DebugOut.Analog[3] = Mittelwert_AccRoll; |
| DebugOut.Analog[4] = MesswertGier; |
| DebugOut.Analog[5] = HoehenWert; |
| DebugOut.Analog[6] =(Mess_Integral_Hoch / 512); |
| DebugOut.Analog[8] = KompassValue; |
| DebugOut.Analog[9] = GyroKomp_Int/GYROKOMP_INC_GRAD_DEFAULT; |
| // Diverse parameter Debugging |
| DebugOut.Analog[16] = dataset_cnt; |
| DebugOut.Analog[17] = UBat; |
| DebugOut.Analog[18] = MesswertNick; |
| DebugOut.Analog[19] = MesswertRoll; |
| DebugOut.Analog[20] = MesswertGier; |
| DebugOut.Analog[21] = StickNick; |
| DebugOut.Analog[22] = StickRoll; |
| DebugOut.Analog[23] = StickGier; |
| // GPS Debugging |
| // DebugOut.Analog[10] = GPS_dist_2trgt/10; |
| // DebugOut.Analog[11] = GPS_hdng_rel_2trgt; |
| DebugOut.Analog[10] = Parameter_UserParam1; |
| DebugOut.Analog[11] = Parameter_UserParam3; |
| DebugOut.Analog[24] = GPS_Nick; |
| DebugOut.Analog[25] = GPS_Roll; |
| DebugOut.Analog[26] = gps_rel_act_position.utm_east; //in 10cm ausgeben |
| DebugOut.Analog[27] = gps_rel_act_position.utm_north; |
| DebugOut.Analog[28] = gps_rel_act_position.utm_alt; |
| DebugOut.Analog[29] = gps_state + (gps_sub_state*10)+(50*gps_cmd); |
| DebugOut.Analog[30] = GPS_dist_2trgt; |
| DebugOut.Analog[31] = (int) GyroGier_Comp; |
| /* DebugOut.Analog[16] = motor_rx[0]; |
| DebugOut.Analog[17] = motor_rx[1]; |
| DebugOut.Analog[18] = motor_rx[2]; |
| DebugOut.Analog[19] = motor_rx[3]; |
| DebugOut.Analog[20] = motor_rx[0] + motor_rx[1] + motor_rx[2] + motor_rx[3]; |
| DebugOut.Analog[20] /= 14; |
| DebugOut.Analog[21] = motor_rx[4]; |
| DebugOut.Analog[22] = motor_rx[5]; |
| DebugOut.Analog[23] = motor_rx[6]; |
| DebugOut.Analog[24] = motor_rx[7]; |
| DebugOut.Analog[25] = motor_rx[4] + motor_rx[5] + motor_rx[6] + motor_rx[7]; |
| */ |
| // DebugOut.Analog[9] = MesswertNick; |
| // DebugOut.Analog[9] = SollHoehe; |
| // DebugOut.Analog[10] = Mess_Integral_Gier / 128; |
| // DebugOut.Analog[11] = KompassStartwert; |
| // DebugOut.Analog[10] = Parameter_Gyro_I; |
| // DebugOut.Analog[10] = EE_Parameter.Gyro_I; |
| // DebugOut.Analog[9] = KompassRichtung; |
| // DebugOut.Analog[10] = GasMischanteil; |
| // DebugOut.Analog[3] = HoeheD * 32; |
| // DebugOut.Analog[4] = hoehenregler; |
| } |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Drehgeschwindigkeit und -winkel zu einem Istwert zusammenfassen |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| if(Looping_Nick) MesswertNick = MesswertNick * GyroFaktor; |
| else MesswertNick = IntegralNick * IntegralFaktor + MesswertNick * GyroFaktor; |
| if(Looping_Roll) MesswertRoll = MesswertRoll * GyroFaktor; |
| else MesswertRoll = IntegralRoll * IntegralFaktor + MesswertRoll * GyroFaktor; |
| // MesswertGier = MesswertGier * (GyroFaktor/2) + Integral_Gier * IntegralFaktor; |
| MesswertGier = MesswertGier * (GyroFaktor) + Integral_Gier * IntegralFaktor/2; |
| //DebugOut.Analog[28] = MesswertRoll; |
| //DebugOut.Analog[25] = IntegralRoll * IntegralFaktor; |
| //DebugOut.Analog[31] = StickRoll;// / (26*IntegralFaktor); |
| // Maximalwerte abfangen |
| #define MAX_SENSOR 2048 |
| if(MesswertNick > MAX_SENSOR) MesswertNick = MAX_SENSOR; |
| if(MesswertNick < -MAX_SENSOR) MesswertNick = -MAX_SENSOR; |
| if(MesswertRoll > MAX_SENSOR) MesswertRoll = MAX_SENSOR; |
| if(MesswertRoll < -MAX_SENSOR) MesswertRoll = -MAX_SENSOR; |
| if(MesswertGier > MAX_SENSOR) MesswertGier = MAX_SENSOR; |
| if(MesswertGier < -MAX_SENSOR) MesswertGier = -MAX_SENSOR; |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Höhenregelung |
| // Die Höhenregelung schwächt lediglich das Gas ab, erhöht es allerdings nicht |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| //OCR0B = 180 - (Poti1 + 120) / 4; |
| //DruckOffsetSetting = OCR0B; |
| if((EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)) // Höhenregelung |
| { |
| int tmp_int; |
| if(EE_Parameter.GlobalConfig & CFG_HOEHEN_SCHALTER) // Regler wird über Schalter gesteuert |
| { |
| if(Parameter_MaxHoehe < 50) |
| { |
| SollHoehe = HoehenWert - 20; // Parameter_MaxHoehe ist der PPM-Wert des Schalters |
| HoehenReglerAktiv = 0; |
| } |
| else |
| HoehenReglerAktiv = 1; |
| } |
| else |
| { |
| SollHoehe = ((int) ExternHoehenValue + (int) Parameter_MaxHoehe) * (int)EE_Parameter.Hoehe_Verstaerkung - 20; |
| HoehenReglerAktiv = 1; |
| } |
| if(Notlandung) SollHoehe = 0; |
| h = HoehenWert; |
| if((h > SollHoehe) && HoehenReglerAktiv) // zu hoch --> drosseln |
| { h = ((h - SollHoehe) * (int) Parameter_Hoehe_P) / 16; // Differenz bestimmen --> P-Anteil |
| h = GasMischanteil - h; // vom Gas abziehen |
| h -= (HoeheD * Parameter_Luftdruck_D)/8; // D-Anteil |
| tmp_int = ((Mess_Integral_Hoch / 512) * (signed long) Parameter_Hoehe_ACC_Wirkung) / 32; |
| if(tmp_int > 50) tmp_int = 50; |
| else if(tmp_int < -50) tmp_int = -50; |
| h -= tmp_int; |
| hoehenregler = (hoehenregler*15 + h) / 16; |
| if(hoehenregler < EE_Parameter.Hoehe_MinGas) // nicht unter MIN |
| { |
| if(GasMischanteil >= EE_Parameter.Hoehe_MinGas) hoehenregler = EE_Parameter.Hoehe_MinGas; |
| if(GasMischanteil < EE_Parameter.Hoehe_MinGas) hoehenregler = GasMischanteil; |
| } |
| if(hoehenregler > GasMischanteil) hoehenregler = GasMischanteil; // nicht mehr als Gas |
| GasMischanteil = hoehenregler; |
| } |
| } |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Mischer und PI-Regler |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| DebugOut.Analog[7] = GasMischanteil; |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Gier-Anteil |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| #define MUL_G 1.0 |
| GierMischanteil = MesswertGier - sollGier; // Regler für Gier |
| //GierMischanteil = 0; |
| if(GierMischanteil > (GasMischanteil / 2)) GierMischanteil = GasMischanteil / 2; |
| if(GierMischanteil < -(GasMischanteil / 2)) GierMischanteil = -(GasMischanteil / 2); |
| if(GierMischanteil > ((MAX_GAS - GasMischanteil))) GierMischanteil = ((MAX_GAS - GasMischanteil)); |
| if(GierMischanteil < -((MAX_GAS - GasMischanteil))) GierMischanteil = -((MAX_GAS - GasMischanteil)); |
| if(GasMischanteil < 20) GierMischanteil = 0; |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Nick-Achse |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| DiffNick = MesswertNick - (StickNick - GPS_Nick); // Differenz bestimmen |
| if(IntegralFaktor) SummeNick += IntegralNick * IntegralFaktor - (StickNick - GPS_Nick); // I-Anteil bei Winkelregelung |
| else SummeNick += DiffNick; // I-Anteil bei HH |
| if(SummeNick > 0) SummeNick-= 2 ; else SummeNick += 2 ; |
| if(SummeNick > 16000) SummeNick = 16000; |
| if(SummeNick < -16000) SummeNick = -16000; |
| pd_ergebnis = DiffNick + Ki * SummeNick; // PI-Regler für Nick |
| // Motor Vorn |
| tmp_int = (long)((long)Parameter_DynamicStability * (long)(GasMischanteil + abs(GierMischanteil)/2)) / 64; |
| if(pd_ergebnis > tmp_int) pd_ergebnis = tmp_int; |
| if(pd_ergebnis < -tmp_int) pd_ergebnis = -tmp_int; |
| motorwert = GasMischanteil + pd_ergebnis + GierMischanteil; // Mischer |
| if ((motorwert < 0)) motorwert = 0; |
| else if(motorwert > MAX_GAS) motorwert = MAX_GAS; |
| if (motorwert < MIN_GAS) motorwert = MIN_GAS; |
| Motor_Vorne = motorwert; |
| // Motor Heck |
| motorwert = GasMischanteil - pd_ergebnis + GierMischanteil; |
| if ((motorwert < 0)) motorwert = 0; |
| else if(motorwert > MAX_GAS) motorwert = MAX_GAS; |
| if (motorwert < MIN_GAS) motorwert = MIN_GAS; |
| Motor_Hinten = motorwert; |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Roll-Achse |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| DiffRoll = MesswertRoll - (StickRoll - GPS_Roll); // Differenz bestimmen |
| if(IntegralFaktor) SummeRoll += IntegralRoll * IntegralFaktor - (StickRoll - GPS_Roll);// I-Anteil bei Winkelregelung |
| else SummeRoll += DiffRoll; // I-Anteil bei HH |
| if(SummeRoll > 0) SummeRoll-= 2 ; else SummeRoll += 2 ; |
| if(SummeRoll > 16000) SummeRoll = 16000; |
| if(SummeRoll < -16000) SummeRoll = -16000; |
| pd_ergebnis = DiffRoll + Ki * SummeRoll; // PI-Regler für Roll |
| tmp_int = (long)((long)Parameter_DynamicStability * (long)(GasMischanteil + abs(GierMischanteil)/2)) / 64; |
| if(pd_ergebnis > tmp_int) pd_ergebnis = tmp_int; |
| if(pd_ergebnis < -tmp_int) pd_ergebnis = -tmp_int; |
| // Motor Links |
| motorwert = GasMischanteil + pd_ergebnis - GierMischanteil; |
| if ((motorwert < 0)) motorwert = 0; |
| else if(motorwert > MAX_GAS) motorwert = MAX_GAS; |
| if (motorwert < MIN_GAS) motorwert = MIN_GAS; |
| Motor_Links = motorwert; |
| // Motor Rechts |
| motorwert = GasMischanteil - pd_ergebnis - GierMischanteil; |
| if ((motorwert < 0)) motorwert = 0; |
| else if(motorwert > MAX_GAS) motorwert = MAX_GAS; |
| if (motorwert < MIN_GAS) motorwert = MIN_GAS; |
| Motor_Rechts = motorwert; |
| // +++++++++++++++++++++++++++++++++++++++++++++++ |
| } |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/fc.h |
|---|
| 0,0 → 1,163 |
| /*####################################################################################### |
| Flight Control |
| #######################################################################################*/ |
| #ifndef _FC_H |
| #define _FC_H |
| extern volatile unsigned int I2CTimeout; |
| //Salvo 9.12.2007 Neutralwerte fuer ACC Sensor nur noch infohalber drin |
| #define ACC_NICK_NEUTRAL 518 // ADC Wandler Wert in Neutrallage (0g): Vom individuellen Sensor abhaengig |
| #define ACC_ROLL_NEUTRAL 516 // ADC Wandler wert in Neutrallage (0g) |
| #define ACC_WAAGRECHT_LIMIT 100 // Nick und Roll kleiner als dieser Wert gelten als Kriterium fuer waagrechte Lage |
| // Salvo End |
| //Salvo 2.9.2007 Ersatzkompass: Gyroincrements/Grad als Defaultwert ***** |
| // Laut Datenblatt sind di; Werte ueber Zeit und Temperatur sehr stabil. |
| #define GYROKOMP_INC_GRAD_DEFAULT 1300 // Gyroincrements/Grad als Defaultwert |
| // Salvo End |
| extern unsigned char Sekunde,Minute; |
| extern volatile long IntegralNick,IntegralNick2; |
| extern volatile long IntegralRoll,IntegralRoll2; |
| extern volatile long Mess_IntegralNick,Mess_IntegralNick2; |
| extern volatile long Mess_IntegralRoll,Mess_IntegralRoll2; |
| extern volatile long IntegralAccNick,IntegralAccRoll; |
| extern volatile long Mess_Integral_Hoch; |
| extern volatile long Integral_Gier,Mess_Integral_Gier,Mess_Integral_Gier2; |
| extern volatile int KompassValue; |
| extern volatile int KompassStartwert; |
| extern volatile int KompassRichtung; |
| extern int HoehenWert; |
| extern int SollHoehe; |
| extern volatile int MesswertNick,MesswertRoll,MesswertGier; |
| extern volatile int AdNeutralNick,AdNeutralRoll,AdNeutralGier, Mittelwert_AccNick, Mittelwert_AccRoll; |
| extern volatile int NeutralAccX, NeutralAccY,Mittelwert_AccHoch; |
| extern volatile float NeutralAccZ; |
| extern long Umschlag180Nick, Umschlag180Roll; |
| extern signed int ExternStickNick,ExternStickRoll,ExternStickGier; |
| extern unsigned char Parameter_UserParam1,Parameter_UserParam2,Parameter_UserParam3,Parameter_UserParam4,Parameter_UserParam5,Parameter_UserParam6,Parameter_UserParam7,Parameter_UserParam8; |
| //Salvo 2.9.2007 Ersatzkompass |
| extern long GyroKomp_Int; |
| extern long int GyroGier_Comp; |
| extern int GyroKomp_Inc_Grad; |
| extern int GyroKomp_Value; // Der ermittelte Kompasswert aus Gyro und Magnetkompass |
| // Salvo End |
| void MotorRegler(void); |
| void SendMotorData(void); |
| void CalibrierMittelwert(void); |
| void Mittelwert(void); |
| void SetNeutral(void); |
| void Piep(unsigned char Anzahl); |
| extern void DefaultKonstanten(void); |
| void DefaultKonstanten1(void); |
| void DefaultKonstanten2(void); |
| extern unsigned char h,m,s; |
| extern volatile unsigned char Timeout ; |
| extern unsigned char CosinusNickWinkel, CosinusRollWinkel; |
| extern volatile long IntegralNick,IntegralNick2; |
| extern volatile long IntegralRoll,IntegralRoll2; |
| extern volatile long Integral_Gier; |
| extern volatile long Mess_IntegralNick,Mess_IntegralNick2; |
| extern volatile long Mess_IntegralRoll,Mess_IntegralRoll2; |
| extern volatile long Mess_Integral_Gier; |
| extern volatile int DiffNick,DiffRoll; |
| extern int Poti1, Poti2, Poti3, Poti4; |
| extern volatile unsigned char Motor_Vorne,Motor_Hinten,Motor_Rechts,Motor_Links, Count; |
| extern unsigned char MotorWert[5]; |
| extern volatile unsigned char SenderOkay; |
| extern int StickNick,StickRoll,StickGier; |
| extern char MotorenEin; |
| extern void DefaultKonstanten1(void); |
| extern void DefaultKonstanten2(void); |
| #define STRUCT_PARAM_LAENGE 71 |
| struct mk_param_struct |
| { |
| unsigned char Kanalbelegung[8]; // GAS[0], GIER[1],NICK[2], ROLL[3], POTI1, POTI2, POTI3 |
| unsigned char GlobalConfig; // 0x01=Höhenregler aktiv,0x02=Kompass aktiv, 0x04=GPS aktiv, 0x08=Heading Hold aktiv |
| unsigned char Hoehe_MinGas; // Wert : 0-100 |
| unsigned char Luftdruck_D; // Wert : 0-250 |
| unsigned char MaxHoehe; // Wert : 0-32 |
| unsigned char Hoehe_P; // Wert : 0-32 |
| unsigned char Hoehe_Verstaerkung; // Wert : 0-50 |
| unsigned char Hoehe_ACC_Wirkung; // Wert : 0-250 |
| unsigned char Stick_P; // Wert : 1-6 |
| unsigned char Stick_D; // Wert : 0-64 |
| unsigned char Gier_P; // Wert : 1-20 |
| unsigned char Gas_Min; // Wert : 0-32 |
| unsigned char Gas_Max; // Wert : 33-250 |
| unsigned char GyroAccFaktor; // Wert : 1-64 |
| unsigned char KompassWirkung; // Wert : 0-32 |
| unsigned char Gyro_P; // Wert : 10-250 |
| unsigned char Gyro_I; // Wert : 0-250 |
| unsigned char UnterspannungsWarnung; // Wert : 0-250 |
| unsigned char NotGas; // Wert : 0-250 //Gaswert bei Empängsverlust |
| unsigned char NotGasZeit; // Wert : 0-250 // Zeitbis auf NotGas geschaltet wird, wg. Rx-Problemen |
| unsigned char UfoAusrichtung; // X oder + Formation |
| unsigned char I_Faktor; // Wert : 0-250 |
| unsigned char UserParam1; // Wert : 0-250 |
| unsigned char UserParam2; // Wert : 0-250 |
| unsigned char UserParam3; // Wert : 0-250 |
| unsigned char UserParam4; // Wert : 0-250 |
| unsigned char ServoNickControl; // Wert : 0-250 // Stellung des Servos |
| unsigned char ServoNickComp; // Wert : 0-250 // Einfluss Gyro/Servo |
| unsigned char ServoNickMin; // Wert : 0-250 // Anschlag |
| unsigned char ServoNickMax; // Wert : 0-250 // Anschlag |
| unsigned char ServoNickRefresh; // |
| unsigned char LoopGasLimit; // Wert: 0-250 max. Gas während Looping |
| unsigned char LoopThreshold; // Wert: 0-250 Schwelle für Stickausschlag |
| unsigned char LoopHysterese; // Wert: 0-250 Hysterese für Stickausschlag |
| unsigned char AchsKopplung1; // Wert: 0-250 Faktor, mit dem Gier die Achsen Roll und Nick koppelt (NickRollMitkopplung) |
| unsigned char AchsGegenKopplung1; // Wert: 0-250 Faktor, mit dem Gier die Achsen Roll und Nick Gegenkoppelt (NickRollGegenkopplung) |
| unsigned char WinkelUmschlagNick; // Wert: 0-250 180°-Punkt |
| unsigned char WinkelUmschlagRoll; // Wert: 0-250 180°-Punkt |
| unsigned char GyroAccAbgleich; // 1/k (Koppel_ACC_Wirkung) |
| unsigned char Driftkomp; |
| unsigned char DynamicStability; |
| unsigned char UserParam5; // Wert : 0-250 |
| unsigned char UserParam6; // Wert : 0-250 |
| unsigned char UserParam7; // Wert : 0-250 |
| unsigned char UserParam8; // Wert : 0-250 |
| //------------------------------------------------ |
| unsigned char LoopConfig; // Bitcodiert: 0x01=oben, 0x02=unten, 0x04=links, 0x08=rechts / wird getrennt behandelt |
| unsigned char ServoNickCompInvert; // Wert : 0-250 0 oder 1 // WICHTIG!!! am Ende lassen |
| unsigned char Reserved[4]; |
| char Name[12]; |
| }; |
| /* |
| unsigned char ServoNickMax; // Wert : 0-250 |
| unsigned char ServoNickRefresh; // |
| unsigned char LoopGasLimit; // Wert: 0-250 max. Gas während Looping |
| unsigned char LoopThreshold; // Wert: 0-250 Schwelle für Stickausschlag |
| //------------------------------------------------ |
| unsigned char LoopConfig; // Bitcodiert: 0x01=oben, 0x02=unten, 0x04=links, 0x08=rechts / wird getrennt behandelt |
| unsigned char ServoNickCompInvert; // Wert : 0-250 0 oder 1 // WICHTIG!!! am Ende lassen |
| unsigned char Reserved[4]; |
| char Name[12]; |
| */ |
| extern struct mk_param_struct EE_Parameter; |
| extern unsigned char Parameter_Luftdruck_D; |
| extern unsigned char Parameter_MaxHoehe; |
| extern unsigned char Parameter_Hoehe_P; |
| extern unsigned char Parameter_Hoehe_ACC_Wirkung; |
| extern unsigned char Parameter_KompassWirkung; |
| extern unsigned char Parameter_Gyro_P; |
| extern unsigned char Parameter_Gyro_I; |
| extern unsigned char Parameter_Gier_P; |
| extern unsigned char Parameter_ServoNickControl; |
| extern unsigned char Parameter_AchsKopplung1; |
| extern unsigned char Parameter_AchsGegenKopplung1; |
| #endif //_FC_H |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/flightctrl.aws |
|---|
| 0,0 → 1,0 |
| <AVRWorkspace><IOSettings><CurrentRegisters/></IOSettings><part name="ATMEGA644"/><Files><File00000 Name="G:\Mikrokopter\Flight_Crtl\v0067g\timer0.c" Position="268 103 1250 595" LineCol="191 0"/><File00001 Name="G:\Mikrokopter\Flight_Crtl\v0067g\analog.h" Position="290 132 1264 594" LineCol="0 0"/><File00002 Name="G:\Mikrokopter\Flight_Crtl\v0067g\makefile" Position="312 161 1286 623" LineCol="411 0"/><File00003 Name="G:\Mikrokopter\Flight_Crtl\v0067g\main.c" Position="334 190 1308 652" LineCol="192 0"/><File00004 Name="G:\Mikrokopter\Flight_Crtl\v0067g\fc.c" Position="356 219 1330 681" LineCol="1093 0"/></Files></AVRWorkspace> |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/gps.h |
|---|
| 0,0 → 1,141 |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Peter Muehlenbrock ("Salvo") |
| // Definitionen fuer Modul GPS |
| // Stand 12.10.007 |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| extern signed int GPS_Nick; |
| extern signed int GPS_Roll; |
| extern signed int GPS_dist_2trgt; //vorzeichenlose Distanz zum Ziel |
| extern signed int GPS_hdng_rel_2trgt; //Winkel zum Ziel bezogen auf Nordachse des Kopters |
| extern void GPS_Neutral(void); |
| extern void Get_Ublox_Msg(uint8_t rx) ; |
| //extern short int Get_GPS_data(void); |
| extern short int Get_Rel_Position(void); |
| extern void GPS_Save_Home(void); |
| extern short int GPS_CRTL(short int cmd); |
| typedef struct { |
| unsigned long utm_itow; // time of week |
| long utm_east; // UTM Ost in cm |
| long utm_north; // UTM Nord in cm |
| long utm_alt; // hoehe in cm |
| uint8_t utm_zone; // |
| uint8_t utm_hem; // Hemisphere Indicator |
| uint8_t status; // 0: kein gueltiges Paket 1: alles ok |
| } NAV_POSUTM_t; |
| typedef struct { |
| unsigned long itow; // time of week |
| uint8_t gpsfix_type;// 3=3D Fix |
| uint8_t nav_status_flag; |
| uint8_t nav_diff_status; |
| uint8_t nav_resevd; |
| long nav_tff; // Time to First Fix in ms |
| long nav_msss; // ms since startup |
| uint8_t status; // 0: kein gueltiges Paket 1: alles ok |
| } NAV_STATUS_t; |
| typedef struct { |
| unsigned long itow; |
| long speed_n; // in cm/s |
| long speed_e; // in cm/s |
| long speed_alt; // in cm/s |
| unsigned long speed_3d; // in cm/s |
| unsigned long speed_gnd; // V ueber Grund in cm/s |
| long heading; // Richtung in deg/10000 |
| unsigned long sacc; // Speed Genauigkeit in cm/s |
| unsigned long cacc; // Richtungsgenauigkeit in deg |
| uint8_t status; // 0: kein gueltiges Paket 1: alles ok |
| } NAV_VELNED_t; |
| typedef struct { |
| long utm_east; // UTM Ost in 10 cm |
| long utm_north; // UTM Nord in 10 cm |
| long utm_alt; // hoehe in 10 cm |
| unsigned long speed_gnd; // V ueber Grund in 10cm/s |
| unsigned heading; // Richtung in Grad |
| uint8_t status; // 0: keine gueltigen Daten 1: alles ok |
| } GPS_ABS_POSITION_t; |
| typedef struct { // Struktur fuer Relative GPS Daten (bezogen z.B. auf Home Position) |
| int utm_east; // UTM Ost in 10 cm |
| int utm_north; // UTM Nord in 10 cm |
| int utm_alt ; // UTM Altitude in 10 cm |
| uint8_t status; // 0: keine gueltigen Daten 1: alles ok |
| } GPS_REL_POSITION_t; |
| extern GPS_ABS_POSITION_t gps_act_position; |
| extern GPS_ABS_POSITION_t gps_home_position; |
| extern GPS_REL_POSITION_t gps_rel_act_position; |
| extern GPS_REL_POSITION_t gps_rel_hold_position; |
| extern short int gps_state,gps_sub_state; |
| extern signed int GPS_hdng_abs_2trgt; |
| extern signed int GPS_hdng_rel_2trgt; |
| extern signed int GPS_dist_2trgt; |
| extern signed int gps_reg_x,gps_reg_y; |
| extern signed int GPS_dist_2trgt; |
| extern unsigned int gps_alive_cnt; |
| //nur provisorisch fuer Debugausgaben |
| extern signed hdng_2home,dist_2home; //Richtung und Entfernung zur home Position |
| extern long int dist_flown; |
| #define GPS_USR_PAR_FKT 8 //Faktor durch den die Userparameter getielt werden |
| // Zustaende der zentralen GPS statemachine |
| #define GPS_CRTL_IDLE 0 // |
| #define GPS_CRTL_HOLD_ACTIVE 1 // Lageregelung aktiv |
| #define GPS_CRTL_HOME_ACTIVE 2 // Rueckflug zur Basis Aktiv |
| #define GPS_HOME_FAST_IN_TOL 3 // Rueckflug: Aktuelle Position innerhalb der Toleranz |
| #define GPS_HOME_FAST_OUTOF_TOL 4 // Rueckflug: Aktuelle Position ausserhalb der Toleranz |
| #define GPS_HOME_RMPDWN_IN_TOL 5 // Rueckflug: beim Abbremsen Position innerhalb der Toleranz |
| #define GPS_HOME_RMPDWN_OUTOF_TOL 6 // Rueckflug: beim Abbremsen Position ausserhalb der Toleranz |
| #define GPS_HOME_IN_TOL 7 // Rueckflug: Nahe am Ziel innerhalb der Toleranz |
| #define GPS_HOME_OUTOF_TOL 8 // Rueckflug: Nahe am Ziel ausserhalb der Toleranz |
| #define GPS_HOME_FINISHED 9 // Rueckflug zur Basis abgeschlossen |
| // Kommandokonstanten fuer die zentrale GPS Statemachine |
| #define GPS_CMD_STOP 0 // Lageregelung soll deaktiviert werden |
| #define GPS_CMD_REQ_INIT 1 // Initialisierung |
| #define GPS_CMD_REQ_HOLD 3 // Lageregelung soll aktiviert werden |
| #define GPS_CMD_REQ_HOME 4 // Das Heimfliegen soll aktiviert werden |
| // Statusmeldungen der zentralen GPS statemachine |
| #define GPS_STST_OK 0 // Kommando erfolgreich und abgeschlossen |
| #define GPS_STST_PEND 1 // Kommando noch nicht komplett durchgefuehrt |
| #define GPS_STST_ERR 2 // Fehler |
| // GPS Lageregler |
| #define GPS_NICKROLL_MAX 40 // Maximaler Einfluss des GPS Lagereglers auf Nick und Roll |
| #define GPS_DIST_MAX 400 // Maximal zulaessige Distanz bevor Regelung gestoppt wird (in 10cm) |
| #define GPS_STICK_HOLDOFF 15 // Wenn der Nick oder Roll Stickwerte groesser sind, wird GPS_HOLD deaktiviert |
| #define GPS_V 8 // Teilerfaktor Regelabweichung zu Ausgabewert |
| // Differenzierer Kennwerte fuer von Distanz abhaengige Verstaerkung, abhaengig vom Modus. |
| #define GPS_DIFF_NRML_MAX_V 20 //maximale Verstaerkung * 10 |
| #define GPS_DIFF_NRML_MAX_D 30 //Entfernung bei der maximale Verstaerkung erreicht wird in 10cm |
| #define GPS_DIFF_FAST_MAX_V 15 //maximale Verstaerkung * 10 im Fast mode |
| #define GPS_DIFF_FAST_MAX_D 50 //Entfernung bei der maximale Verstaerkung erreicht wird in 10cm im Fast mode |
| // P-Regler Verstaerkung |
| #define GPS_PROP_NRML_V 2 //maximale Verstaerkung * 2 |
| #define GPS_PROP_FAST_V 2 //maximale Verstaerkung * 2 im Fast mode |
| // GPS G2T /Go to Target Regler |
| #define GPS_G2T_DIST_MAX_STOP 50 // Ab dieser Entfernung vom Zielpunkt soll die Geschwindigkeit runtergeregelt werden( in 10 cm) |
| #define GPS_G2T_DIST_HOLD 30 // Ab dieser Entfernung vom Zielpunkt wird mit Minimaler Geschwindigkeit eingeregelt |
| #define GPS_G2T_V_MAX 12 // Maximale Geschwindigkeit (in 10cm/0.25 Sekunden) mit der der Sollpunkt geaendert wird. |
| #define GPS_G2T_V_RAMP_DWN 6 // Geschwindigkeit (in 10cm/0.25ekunden) in der Naehe der Home Position um abzubremsen |
| #define GPS_G2T_V_MIN 3 // Minimale (in 10cm/0.25 Sekunden) ganz nahe an Homeposition. |
| #define GPS_G2T_FAST_TOL 60 // Bei grosser Entfernung vom Ziel: Der Sollwert wird nur geaendert wenn die aktuelle Position nicht mehr als diesem Wert vom Sollwert abweicht |
| #define GPS_G2T_NRML_TOL 40 // Bei kleiner Entfernung vom Ziel: Der Sollwert wird nur geaendert wenn die aktuelle Position nicht mehr als diesem Wert vom Sollwert abweicht |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/main.c |
|---|
| 0,0 → 1,254 |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Copyright (c) 04.2007 Holger Buss |
| // + Nur für den privaten Gebrauch |
| // + www.MikroKopter.com |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Es gilt für das gesamte Projekt (Hardware, Software, Binärfiles, Sourcecode und Dokumentation), |
| // + dass eine Nutzung (auch auszugsweise) nur für den privaten und nicht-kommerziellen Gebrauch zulässig ist. |
| // + Sollten direkte oder indirekte kommerzielle Absichten verfolgt werden, ist mit uns (info@mikrokopter.de) Kontakt |
| // + bzgl. der Nutzungsbedingungen aufzunehmen. |
| // + Eine kommerzielle Nutzung ist z.B.Verkauf von MikroKoptern, Bestückung und Verkauf von Platinen oder Bausätzen, |
| // + Verkauf von Luftbildaufnahmen, usw. |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Werden Teile des Quellcodes (mit oder ohne Modifikation) weiterverwendet oder veröffentlicht, |
| // + unterliegen sie auch diesen Nutzungsbedingungen und diese Nutzungsbedingungen incl. Copyright müssen dann beiliegen |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Sollte die Software (auch auszugesweise) oder sonstige Informationen des MikroKopter-Projekts |
| // + auf anderen Webseiten oder Medien veröffentlicht werden, muss unsere Webseite "http://www.mikrokopter.de" |
| // + eindeutig als Ursprung verlinkt und genannt werden |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Keine Gewähr auf Fehlerfreiheit, Vollständigkeit oder Funktion |
| // + Benutzung auf eigene Gefahr |
| // + Wir übernehmen keinerlei Haftung für direkte oder indirekte Personen- oder Sachschäden |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Die Portierung der Software (oder Teile davon) auf andere Systeme (ausser der Hardware von www.mikrokopter.de) ist nur |
| // + mit unserer Zustimmung zulässig |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Die Funktion printf_P() unterliegt ihrer eigenen Lizenz und ist hiervon nicht betroffen |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Redistributions of source code (with or without modifications) must retain the above copyright notice, |
| // + this list of conditions and the following disclaimer. |
| // + * Neither the name of the copyright holders nor the names of contributors may be used to endorse or promote products derived |
| // + from this software without specific prior written permission. |
| // + * The use of this project (hardware, software, binary files, sources and documentation) is only permittet |
| // + for non-commercial use (directly or indirectly) |
| // + Commercial use (for excample: selling of MikroKopters, selling of PCBs, assembly, ...) is only permitted |
| // + with our written permission |
| // + * If sources or documentations are redistributet on other webpages, out webpage (http://www.MikroKopter.de) must be |
| // + clearly linked as origin |
| // + * porting to systems other than hardware from www.mikrokopter.de is not allowed |
| // + THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
| // + AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| // + IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| // + ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE |
| // + LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| // + CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| // + SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
| // + INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
| // + CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
| // + ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| // + POSSIBILITY OF SUCH DAMAGE. |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| #include "main.h" |
| unsigned char EEPromArray[E2END+1] EEMEM; |
| unsigned char PlatinenVersion = 10; |
| // -- Parametersatz aus EEPROM lesen --- |
| // number [0..5] |
| void ReadParameterSet(unsigned char number, unsigned char *buffer, unsigned char length) |
| { |
| if (number > 5) number = 5; |
| eeprom_read_block(buffer, &EEPromArray[EEPROM_ADR_PARAM_BEGIN + length * number], length); |
| } |
| // -- Parametersatz ins EEPROM schreiben --- |
| // number [0..5] |
| void WriteParameterSet(unsigned char number, unsigned char *buffer, unsigned char length) |
| { |
| if(number > 5) number = 5; |
| eeprom_write_block(buffer, &EEPromArray[EEPROM_ADR_PARAM_BEGIN + length * number], length); |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACTIVE_SET], number); // diesen Parametersatz als aktuell merken |
| } |
| unsigned char GetActiveParamSetNumber(void) |
| { |
| unsigned char set; |
| set = eeprom_read_byte(&EEPromArray[EEPROM_ADR_ACTIVE_SET]); |
| if(set > 5) |
| { |
| set = 2; |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACTIVE_SET], set); // diesen Parametersatz als aktuell merken |
| } |
| return(set); |
| } |
| //############################################################################ |
| //Hauptprogramm |
| int main (void) |
| //############################################################################ |
| { |
| unsigned int timer; |
| //unsigned int timer2 = 0; |
| DDRB = 0x00; |
| PORTB = 0x00; |
| for(timer = 0; timer < 1000; timer++); // verzögern |
| if(PINB & 0x01) PlatinenVersion = 11; else PlatinenVersion = 10; |
| // Salvo 9.12.2007 PC6 als Ausgang |
| // DDRC = 0x81; // SCL |
| DDRC = 0xCD; // SCL und PC2,PC3, PC6 als Ausgang |
| PORTC = 0xff; // Pullup SDA |
| DDRB = 0x1B; // LEDs und Druckoffset |
| PORTB = 0x01; // LED_Rot |
| DDRD = 0x3E; // Speaker & TXD & J3 J4 J5 |
| DDRD |=0x80; // J7 |
| PORTD = 0xF7; // LED |
| MCUSR &=~(1<<WDRF); |
| WDTCSR |= (1<<WDCE)|(1<<WDE); |
| WDTCSR = 0; |
| beeptime = 2000; |
| StickGier = 0; PPM_in[K_GAS] = 0;StickRoll = 0; StickNick = 0; |
| ROT_OFF; |
| Timer_Init(); |
| UART_Init(); |
| rc_sum_init(); |
| ADC_Init(); |
| i2c_init(); |
| // SPI_MasterInit(); |
| sei(); |
| VersionInfo.Hauptversion = VERSION_HAUPTVERSION; |
| VersionInfo.Nebenversion = VERSION_NEBENVERSION; |
| VersionInfo.PCKompatibel = VERSION_KOMPATIBEL; |
| printf("\n\rFlightControl\n\rHardware:%d.%d\n\rSoftware:V%d.%d%c ",PlatinenVersion/10,PlatinenVersion%10, VERSION_HAUPTVERSION, VERSION_NEBENVERSION,VERSION_INDEX + 'a'); |
| printf("\n\r=============================="); |
| GRN_ON; |
| #define EE_DATENREVISION 68 // wird angepasst, wenn sich die EEPROM-Daten geändert haben |
| if(eeprom_read_byte(&EEPromArray[EEPROM_ADR_VALID]) != EE_DATENREVISION) |
| { |
| printf("\n\rInit. EEPROM: Generiere Default-Parameter..."); |
| DefaultKonstanten1(); |
| for (unsigned char i=0;i<6;i++) |
| { |
| if(i==2) DefaultKonstanten2(); // Kamera |
| if(i==3) DefaultKonstanten3(); // Beginner |
| if(i>3) DefaultKonstanten2(); // Kamera |
| WriteParameterSet(i, (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE); |
| } |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACTIVE_SET], 3); // default-Setting |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_VALID], EE_DATENREVISION); |
| } |
| if(eeprom_read_byte(&EEPromArray[EEPROM_ADR_ACC_NICK]) > 4) |
| { |
| printf("\n\rACC nicht abgeglichen!"); |
| } |
| ReadParameterSet(GetActiveParamSetNumber(), (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE); |
| printf("\n\rBenutze Parametersatz %d", GetActiveParamSetNumber()); |
| if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG) |
| { |
| printf("\n\rAbgleich Luftdrucksensor.."); |
| timer = SetDelay(1000); |
| SucheLuftruckOffset(); |
| while (!CheckDelay(timer)); |
| printf("OK\n\r"); |
| } |
| SetNeutral(); |
| ROT_OFF; |
| // Salvo 9.12.2007 Defaultwert fuer Umschaltsignal fuer RX: Bluettooth Modul aktiv |
| RX_SWTCH_OFF; |
| // Salvo End |
| beeptime = 2000; |
| DebugIn.Analog[1] = 1000; |
| DebugIn.Digital[0] = 0x55; |
| printf("\n\rSteuerung: "); |
| if (EE_Parameter.GlobalConfig & CFG_HEADING_HOLD) printf("HeadingHold"); |
| else printf("Neutral"); |
| printf("\n\n\r"); |
| LcdClear(); |
| I2CTimeout = 5000; |
| while (1) |
| { |
| if (UpdateMotor) // ReglerIntervall |
| { |
| // SPI_TransmitByte(); |
| UpdateMotor=0; |
| //PORTD |= 0x08; |
| MotorRegler(); |
| //PORTD &= ~0x08; |
| SendMotorData(); |
| ROT_OFF; |
| if(PcZugriff) PcZugriff--; |
| else |
| { |
| DubWiseKeys[0] = 0; |
| DubWiseKeys[1] = 0; |
| ExternStickNick = 0; |
| ExternStickRoll = 0; |
| ExternStickGier = 0; |
| } |
| if(SenderOkay) SenderOkay--; |
| if(!I2CTimeout) |
| { |
| I2CTimeout = 5; |
| i2c_reset(); |
| if((BeepMuster == 0xffff) && MotorenEin) |
| { |
| beeptime = 10000; |
| BeepMuster = 0x0080; |
| } |
| } |
| else |
| { |
| I2CTimeout--; |
| ROT_OFF; |
| } |
| } |
| if(SIO_DEBUG) |
| { |
| DatenUebertragung(); |
| BearbeiteRxDaten(); |
| } |
| else BearbeiteRxDaten(); |
| if(CheckDelay(timer)) |
| { |
| if(UBat < EE_Parameter.UnterspannungsWarnung) |
| { |
| if(BeepMuster == 0xffff) |
| { |
| beeptime = 6000; |
| BeepMuster = 0x0300; |
| } |
| } |
| // SPI_StartTransmitPacket(); |
| timer = SetDelay(100); |
| } |
| } |
| return (1); |
| } |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/main.h |
|---|
| 0,0 → 1,112 |
| #ifndef _MAIN_H |
| #define _MAIN_H |
| //Hier die Quarz Frequenz einstellen |
| #if defined (__AVR_ATmega32__) |
| #define SYSCLK 20000000L //Quarz Frequenz in Hz |
| #endif |
| #if defined (__AVR_ATmega644__) |
| #define SYSCLK 20000000L //Quarz Frequenz in Hz |
| //#define SYSCLK 16000000L //Quarz Frequenz in Hz |
| #endif |
| // neue Hardware |
| #define ROT_OFF {if(PlatinenVersion == 10) PORTB &=~0x01; else PORTB |= 0x01;} |
| #define ROT_ON {if(PlatinenVersion == 10) PORTB |= 0x01; else PORTB &=~0x01;} |
| #define ROT_FLASH PORTB ^= 0x01 |
| #define GRN_OFF PORTB &=~0x02 |
| #define GRN_ON PORTB |= 0x02 |
| #define GRN_FLASH PORTB ^= 0x02 |
| //Salvo 9.12.2007 Umschaltsignal fuer Bluetooth bzw. GPS Daten auf PC7 |
| #define RX_SWTCH_ON PORTC |= 0x40 |
| #define RX_SWTCH_OFF PORTC &= ~0x40 |
| #define LED_J16_ON PORTC |= 0x04 |
| #define LED_J16_OFF PORTC &= ~0x04 |
| #define LED_J16_FLASH PORTC ^= 0x04 |
| //Salvo End |
| #define F_CPU SYSCLK |
| //#ifndef F_CPU |
| //#error ################## F_CPU nicht definiert oder ungültig ############# |
| //#endif |
| //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| #define EEPROM_ADR_VALID 1 |
| #define EEPROM_ADR_ACTIVE_SET 2 |
| #define EEPROM_ADR_LAST_OFFSET 3 |
| #define EEPROM_ADR_ACC_NICK 4 |
| #define EEPROM_ADR_ACC_ROLL 6 |
| #define EEPROM_ADR_ACC_Z 8 |
| #define EEPROM_ADR_PARAM_BEGIN 100 |
| #define CFG_HOEHENREGELUNG 0x01 |
| #define CFG_HOEHEN_SCHALTER 0x02 |
| #define CFG_HEADING_HOLD 0x04 |
| #define CFG_KOMPASS_AKTIV 0x08 |
| #define CFG_KOMPASS_FIX 0x10 |
| #define CFG_GPS_AKTIV 0x20 |
| #define CFG_ACHSENKOPPLUNG_AKTIV 0x40 |
| #define CFG_DREHRATEN_BEGRENZER 0x80 |
| #define CFG_LOOP_OBEN 0x01 |
| #define CFG_LOOP_UNTEN 0x02 |
| #define CFG_LOOP_LINKS 0x04 |
| #define CFG_LOOP_RECHTS 0x08 |
| //#define SYSCLK |
| //extern unsigned long SYSCLK; |
| extern volatile int i_Nick[20],i_Roll[20],DiffNick,DiffRoll; |
| extern volatile unsigned char SenderOkay; |
| extern unsigned char CosinusNickWinkel, CosinusRollWinkel; |
| extern unsigned char PlatinenVersion; |
| void ReadParameterSet (unsigned char number, unsigned char *buffer, unsigned char length); |
| void WriteParameterSet(unsigned char number, unsigned char *buffer, unsigned char length); |
| extern unsigned char GetActiveParamSetNumber(void); |
| extern unsigned char EEPromArray[]; |
| #include <stdlib.h> |
| #include <string.h> |
| #include <avr/io.h> |
| #include <avr/pgmspace.h> |
| #include <avr/interrupt.h> |
| #include <avr/eeprom.h> |
| #include <avr/boot.h> |
| #include <avr/wdt.h> |
| #include "old_macros.h" |
| #include "_Settings.h" |
| #include "printf_P.h" |
| #include "timer0.h" |
| #include "uart.h" |
| #include "analog.h" |
| #include "twimaster.h" |
| #include "menu.h" |
| #include "rc.h" |
| #include "fc.h" |
| #include "gps.h" |
| #include "spi.h" |
| #ifndef EEMEM |
| #define EEMEM __attribute__ ((section (".eeprom"))) |
| #endif |
| #define DEBUG_DISPLAY_INTERVALL 123 // in ms |
| #define DELAY_US(x) ((unsigned int)( (x) * 1e-6 * F_CPU )) |
| #endif //_MAIN_H |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/makefile |
|---|
| 0,0 → 1,411 |
| #-------------------------------------------------------------------- |
| # MCU name |
| MCU = atmega644 |
| F_CPU = 20000000 |
| #------------------------------------------------------------------- |
| HAUPT_VERSION = 0 |
| NEBEN_VERSION = 01 |
| VERSION_INDEX = 0 |
| VERSION_KOMPATIBEL = 7 # PC-Kompatibilität |
| #------------------------------------------------------------------- |
| ifeq ($(MCU), atmega32) |
| # FUSE_SETTINGS= -u -U lfuse:w:0xff:m -U hfuse:w:0xcf:m |
| HEX_NAME = MEGA32 |
| endif |
| ifeq ($(MCU), atmega644) |
| FUSE_SETTINGS = -u -U lfuse:w:0xff:m -U hfuse:w:0xdf:m |
| #FUSE_SETTINGS = -U lfuse:w:0xff:m -U hfuse:w:0xdf:m |
| # -u bei neuen Controllern wieder einspielen |
| HEX_NAME = MEGA644 |
| endif |
| ifeq ($(F_CPU), 16000000) |
| QUARZ = 16MHZ |
| endif |
| ifeq ($(F_CPU), 20000000) |
| QUARZ = 20MHZ |
| endif |
| # Output format. (can be srec, ihex, binary) |
| FORMAT = ihex |
| # Target file name (without extension). |
| ifeq ($(VERSION_INDEX), 0) |
| TARGET = Flight-Ctrl_$(HEX_NAME)_V$(HAUPT_VERSION)_$(NEBEN_VERSION)a |
| endif |
| ifeq ($(VERSION_INDEX), 1) |
| TARGET = Flight-Ctrl_$(HEX_NAME)_V$(HAUPT_VERSION)_$(NEBEN_VERSION)b |
| endif |
| ifeq ($(VERSION_INDEX), 2) |
| TARGET = Flight-Ctrl_$(HEX_NAME)_V$(HAUPT_VERSION)_$(NEBEN_VERSION)c |
| endif |
| ifeq ($(VERSION_INDEX), 3) |
| TARGET = Flight-Ctrl_$(HEX_NAME)_V$(HAUPT_VERSION)_$(NEBEN_VERSION)d |
| endif |
| ifeq ($(VERSION_INDEX), 4) |
| TARGET = Flight-Ctrl_$(HEX_NAME)_V$(HAUPT_VERSION)_$(NEBEN_VERSION)e |
| endif |
| ifeq ($(VERSION_INDEX), 5) |
| TARGET = Flight-Ctrl_$(HEX_NAME)_V$(HAUPT_VERSION)_$(NEBEN_VERSION)f |
| endif |
| # Optimization level, can be [0, 1, 2, 3, s]. 0 turns off optimization. |
| # (Note: 3 is not always the best optimization level. See avr-libc FAQ.) |
| OPT = s |
| ########################################################################################################## |
| # List C source files here. (C dependencies are automatically generated.) |
| SRC = main.c uart.c printf_P.c timer0.c analog.c menu.c |
| SRC += twimaster.c rc.c fc.c GPS.c math.c |
| #spi.c |
| ########################################################################################################## |
| # List Assembler source files here. |
| # Make them always end in a capital .S. Files ending in a lowercase .s |
| # will not be considered source files but generated files (assembler |
| # output from the compiler), and will be deleted upon "make clean"! |
| # Even though the DOS/Win* filesystem matches both .s and .S the same, |
| # it will preserve the spelling of the filenames, and gcc itself does |
| # care about how the name is spelled on its command-line. |
| ASRC = |
| # List any extra directories to look for include files here. |
| # Each directory must be seperated by a space. |
| EXTRAINCDIRS = |
| # Optional compiler flags. |
| # -g: generate debugging information (for GDB, or for COFF conversion) |
| # -O*: optimization level |
| # -f...: tuning, see gcc manual and avr-libc documentation |
| # -Wall...: warning level |
| # -Wa,...: tell GCC to pass this to the assembler. |
| # -ahlms: create assembler listing |
| CFLAGS = -O$(OPT) \ |
| -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums \ |
| -Wall -Wstrict-prototypes \ |
| -Wa,-adhlns=$(<:.c=.lst) \ |
| $(patsubst %,-I%,$(EXTRAINCDIRS)) |
| # Set a "language standard" compiler flag. |
| # Unremark just one line below to set the language standard to use. |
| # gnu99 = C99 + GNU extensions. See GCC manual for more information. |
| #CFLAGS += -std=c89 |
| #CFLAGS += -std=gnu89 |
| #CFLAGS += -std=c99 |
| CFLAGS += -std=gnu99 |
| CFLAGS += -DVERSION_HAUPTVERSION=$(HAUPT_VERSION) -DVERSION_NEBENVERSION=$(NEBEN_VERSION) -DVERSION_KOMPATIBEL=$(VERSION_KOMPATIBEL) -DVERSION_INDEX=$(VERSION_INDEX) |
| # Optional assembler flags. |
| # -Wa,...: tell GCC to pass this to the assembler. |
| # -ahlms: create listing |
| # -gstabs: have the assembler create line number information; note that |
| # for use in COFF files, additional information about filenames |
| # and function names needs to be present in the assembler source |
| # files -- see avr-libc docs [FIXME: not yet described there] |
| ASFLAGS = -Wa,-adhlns=$(<:.S=.lst),-gstabs |
| # Optional linker flags. |
| # -Wl,...: tell GCC to pass this to linker. |
| # -Map: create map file |
| # --cref: add cross reference to map file |
| LDFLAGS = -Wl,-Map=$(TARGET).map,--cref |
| # Additional libraries |
| # Minimalistic printf version |
| #LDFLAGS += -Wl,-u,vfprintf -lprintf_min |
| # Floating point printf version (requires -lm below) |
| #LDFLAGS += -Wl,-u,vfprintf -lprintf_flt |
| # -lm = math library |
| LDFLAGS += -lm |
| ##LDFLAGS += -T./linkerfile/avr5.x |
| # Programming support using avrdude. Settings and variables. |
| # Programming hardware: alf avr910 avrisp bascom bsd |
| # dt006 pavr picoweb pony-stk200 sp12 stk200 stk500 |
| # |
| # Type: avrdude -c ? |
| # to get a full listing. |
| # |
| #AVRDUDE_PROGRAMMER = stk200 |
| AVRDUDE_PROGRAMMER = dt006 |
| #AVRDUDE_PROGRAMMER = ponyser |
| #falls Ponyser ausgewählt wird, muss sich unsere avrdude-Configdatei im Bin-Verzeichnis des Compilers befinden |
| #AVRDUDE_PORT = com1 # programmer connected to serial device |
| AVRDUDE_PORT = lpt1 # programmer connected to parallel port |
| #AVRDUDE_WRITE_FLASH = -U flash:w:$(TARGET).hex |
| AVRDUDE_WRITE_FLASH = -U flash:w:$(TARGET).hex $(FUSE_SETTINGS) |
| #AVRDUDE_WRITE_EEPROM = -U eeprom:w:$(TARGET).eep |
| AVRDUDE_FLAGS = -p $(MCU) -P $(AVRDUDE_PORT) -c $(AVRDUDE_PROGRAMMER) |
| # Uncomment the following if you want avrdude's erase cycle counter. |
| # Note that this counter needs to be initialized first using -Yn, |
| # see avrdude manual. |
| #AVRDUDE_ERASE += -y |
| # Uncomment the following if you do /not/ wish a verification to be |
| # performed after programming the device. |
| AVRDUDE_FLAGS += -V |
| # Increase verbosity level. Please use this when submitting bug |
| # reports about avrdude. See <http://savannah.nongnu.org/projects/avrdude> |
| # to submit bug reports. |
| #AVRDUDE_FLAGS += -v -v |
| # --------------------------------------------------------------------------- |
| # Define directories, if needed. |
| DIRAVR = c:/winavr |
| DIRAVRBIN = $(DIRAVR)/bin |
| DIRAVRUTILS = $(DIRAVR)/utils/bin |
| DIRINC = . |
| DIRLIB = $(DIRAVR)/avr/lib |
| # Define programs and commands. |
| SHELL = sh |
| CC = avr-gcc |
| OBJCOPY = avr-objcopy |
| OBJDUMP = avr-objdump |
| SIZE = avr-size |
| # Programming support using avrdude. |
| AVRDUDE = avrdude |
| REMOVE = rm -f |
| COPY = cp |
| HEXSIZE = $(SIZE) --target=$(FORMAT) $(TARGET).hex |
| ELFSIZE = $(SIZE) -A $(TARGET).elf |
| # Define Messages |
| # English |
| MSG_ERRORS_NONE = Errors: none |
| MSG_BEGIN = -------- begin -------- |
| MSG_END = -------- end -------- |
| MSG_SIZE_BEFORE = Size before: |
| MSG_SIZE_AFTER = Size after: |
| MSG_COFF = Converting to AVR COFF: |
| MSG_EXTENDED_COFF = Converting to AVR Extended COFF: |
| MSG_FLASH = Creating load file for Flash: |
| MSG_EEPROM = Creating load file for EEPROM: |
| MSG_EXTENDED_LISTING = Creating Extended Listing: |
| MSG_SYMBOL_TABLE = Creating Symbol Table: |
| MSG_LINKING = Linking: |
| MSG_COMPILING = Compiling: |
| MSG_ASSEMBLING = Assembling: |
| MSG_CLEANING = Cleaning project: |
| # Define all object files. |
| OBJ = $(SRC:.c=.o) $(ASRC:.S=.o) |
| # Define all listing files. |
| LST = $(ASRC:.S=.lst) $(SRC:.c=.lst) |
| # Combine all necessary flags and optional flags. |
| # Add target processor to flags. |
| #ALL_CFLAGS = -mmcu=$(MCU) -DF_CPU=$(F_CPU) -I. $(CFLAGS) |
| ALL_CFLAGS = -mmcu=$(MCU) -I. $(CFLAGS) |
| ALL_ASFLAGS = -mmcu=$(MCU) -I. -x assembler-with-cpp $(ASFLAGS) |
| # Default target. |
| all: begin gccversion sizebefore $(TARGET).elf $(TARGET).hex $(TARGET).eep \ |
| $(TARGET).lss $(TARGET).sym sizeafter finished end |
| # Eye candy. |
| # AVR Studio 3.x does not check make's exit code but relies on |
| # the following magic strings to be generated by the compile job. |
| begin: |
| @echo |
| @echo $(MSG_BEGIN) |
| finished: |
| @echo $(MSG_ERRORS_NONE) |
| end: |
| @echo $(MSG_END) |
| @echo |
| # Display size of file. |
| sizebefore: |
| @if [ -f $(TARGET).elf ]; then echo; echo $(MSG_SIZE_BEFORE); $(ELFSIZE); echo; fi |
| sizeafter: |
| @if [ -f $(TARGET).elf ]; then echo; echo $(MSG_SIZE_AFTER); $(ELFSIZE); echo; fi |
| # Display compiler version information. |
| gccversion : |
| @$(CC) --version |
| # Convert ELF to COFF for use in debugging / simulating in |
| # AVR Studio or VMLAB. |
| COFFCONVERT=$(OBJCOPY) --debugging \ |
| --change-section-address .data-0x800000 \ |
| --change-section-address .bss-0x800000 \ |
| --change-section-address .noinit-0x800000 \ |
| --change-section-address .eeprom-0x810000 |
| coff: $(TARGET).elf |
| @echo |
| @echo $(MSG_COFF) $(TARGET).cof |
| $(COFFCONVERT) -O coff-avr $< $(TARGET).cof |
| extcoff: $(TARGET).elf |
| @echo |
| @echo $(MSG_EXTENDED_COFF) $(TARGET).cof |
| $(COFFCONVERT) -O coff-ext-avr $< $(TARGET).cof |
| # Program the device. |
| program: $(TARGET).hex $(TARGET).eep |
| $(AVRDUDE) $(AVRDUDE_FLAGS) $(AVRDUDE_WRITE_FLASH) $(AVRDUDE_WRITE_EEPROM) |
| # Create final output files (.hex, .eep) from ELF output file. |
| %.hex: %.elf |
| @echo |
| @echo $(MSG_FLASH) $@ |
| $(OBJCOPY) -O $(FORMAT) -R .eeprom $< $@ |
| %.eep: %.elf |
| @echo |
| @echo $(MSG_EEPROM) $@ |
| -$(OBJCOPY) -j .eeprom --set-section-flags=.eeprom="alloc,load" \ |
| --change-section-lma .eeprom=0 -O $(FORMAT) $< $@ |
| # Create extended listing file from ELF output file. |
| %.lss: %.elf |
| @echo |
| @echo $(MSG_EXTENDED_LISTING) $@ |
| $(OBJDUMP) -h -S $< > $@ |
| # Create a symbol table from ELF output file. |
| %.sym: %.elf |
| @echo |
| @echo $(MSG_SYMBOL_TABLE) $@ |
| avr-nm -n $< > $@ |
| # Link: create ELF output file from object files. |
| .SECONDARY : $(TARGET).elf |
| .PRECIOUS : $(OBJ) |
| %.elf: $(OBJ) |
| @echo |
| @echo $(MSG_LINKING) $@ |
| $(CC) $(ALL_CFLAGS) $(OBJ) --output $@ $(LDFLAGS) |
| # Compile: create object files from C source files. |
| %.o : %.c |
| @echo |
| @echo $(MSG_COMPILING) $< |
| $(CC) -c $(ALL_CFLAGS) $< -o $@ |
| # Compile: create assembler files from C source files. |
| %.s : %.c |
| $(CC) -S $(ALL_CFLAGS) $< -o $@ |
| # Assemble: create object files from assembler source files. |
| %.o : %.S |
| @echo |
| @echo $(MSG_ASSEMBLING) $< |
| $(CC) -c $(ALL_ASFLAGS) $< -o $@ |
| # Target: clean project. |
| clean: begin clean_list finished end |
| clean_list : |
| @echo |
| @echo $(MSG_CLEANING) |
| # $(REMOVE) $(TARGET).hex |
| $(REMOVE) $(TARGET).eep |
| $(REMOVE) $(TARGET).obj |
| $(REMOVE) $(TARGET).cof |
| $(REMOVE) $(TARGET).elf |
| $(REMOVE) $(TARGET).map |
| $(REMOVE) $(TARGET).obj |
| $(REMOVE) $(TARGET).a90 |
| $(REMOVE) $(TARGET).sym |
| $(REMOVE) $(TARGET).lnk |
| $(REMOVE) $(TARGET).lss |
| $(REMOVE) $(OBJ) |
| $(REMOVE) $(LST) |
| $(REMOVE) $(SRC:.c=.s) |
| $(REMOVE) $(SRC:.c=.d) |
| # Automatically generate C source code dependencies. |
| # (Code originally taken from the GNU make user manual and modified |
| # (See README.txt Credits).) |
| # |
| # Note that this will work with sh (bash) and sed that is shipped with WinAVR |
| # (see the SHELL variable defined above). |
| # This may not work with other shells or other seds. |
| # |
| %.d: %.c |
| set -e; $(CC) -MM $(ALL_CFLAGS) $< \ |
| | sed 's,\(.*\)\.o[ :]*,\1.o \1.d : ,g' > $@; \ |
| [ -s $@ ] || rm -f $@ |
| # Remove the '-' if you want to see the dependency files generated. |
| -include $(SRC:.c=.d) |
| # Listing of phony targets. |
| .PHONY : all begin finish end sizebefore sizeafter gccversion coff extcoff \ |
| clean clean_list program |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/math.c |
|---|
| 0,0 → 1,127 |
| /* |
| This program (files math.c and math.h) is free software; you can redistribute it and/or modify |
| it under the terms of the GNU Lesser General Public License as published by the Free Software Foundation; |
| either version 3 of the License, or (at your option) any later version. |
| This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; |
| without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| GNU General Public License and GNU Lesser General Public License for more details. |
| You should have received a copy of GNU General Public License (License_GPL.txt) and |
| GNU Lesser General Public License (License_LGPL.txt) along with this program. |
| If not, see <http://www.gnu.org/licenses/>. |
| Please note: All the other files for the project "Mikrokopter" by H.Buss are under the license (license_buss.txt) published by www.mikrokopter.de |
| */ |
| /*++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| Peter Muehlenbrock |
| Winkelfunktionen sin, cos und arctan in |
| brute-force Art: Sehr Schnell, nicht sonderlich genau, aber ausreichend |
| get_dist Funktion fuer Entfernungsermittlung |
| Stand 12.10.2007 |
| ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| */ |
| #include "main.h" |
| #include "math.h" |
| // arctan Funktion: Eingabewert x,y Rueckgabe =arctan(x,y) in grad |
| int arctan_i( signed int x, signed int y) |
| { |
| short int change_xy = 0; |
| signed int i; |
| long signed int wert; |
| int return_value; |
| if ((abs(x)) > (abs(y))) // x,y Werte vertauschen damit arctan <45 grad bleibt |
| { |
| change_xy = 1; |
| i = x; |
| x = y; |
| y = i; |
| } |
| // Quadranten ermitteln |
| // Wert durch lineare Interpolation ermitteln |
| if ((y == 0) && (x == 0)) wert =1; // Division durch 0 nicht erlaubt |
| else wert= abs(((long)x*1000)/((long)y)); |
| if (wert <=268) //0...0.0,268 entsprechend 0..15 Grad |
| { |
| return_value = (signed int)((wert*100)/(268-0)*(15-0)/100) +0; |
| } |
| else if (wert <=578) //0,268...0.0,568 entsprechend 15..30 Grad |
| { |
| return_value = (signed int)((((wert-268)*100)/(578-268)*(30-15))/100) +15; |
| } |
| else //0,568...1 entsprechend 30..45 Grad |
| { |
| return_value = (signed int)((((wert-578)*50)/(1000-578)*(45-30))/50) +30; |
| } |
| if (change_xy == 0) return_value = 90-return_value; //Quadrant 45..90 Grad |
| if ((x >= 0) && (y <0)) return_value = - return_value; |
| else if ((x < 0) && (y >= 0)) return_value = - return_value; |
| return return_value; |
| } |
| // cosinus Funktion: Eingabewert Winkel in Grad, Rueckgabe =cos(winkel)*1000 |
| signed int cos_i(signed int winkel) |
| { |
| winkel = sin_i(90-winkel); |
| return winkel; |
| } |
| const unsigned int pgm_sinus[91] PROGMEM = {0,17,35,52,70,87,105,122,139,156,174,191,208,225,242,259,276,292,309,326,342,358,375,391,407,423,438,454,469,485,500,515,530,545,559,574,588,602,616,629,643,656,669,682,695,707,719,731,743,755,766,777,788,799,809,819,829,839,848,857,866,875,883,891,899,906,914,921,927,934,940,946,951,956,961,966,970,974,978,982,985,988,990,993,995,996,998,999,999,1000,1000}; |
| //von Nick666, Stand 28.9.2007 |
| // sinus Funktion: Eingabewert Winkel in Grad, Rueckgabe =sin(winkel)*1000 |
| signed int sin_i(signed int winkel) |
| { |
| short int m,n; |
| if (abs(winkel) >=360) winkel = winkel % 360; |
| if (winkel < 0) |
| { |
| m = -1; |
| winkel = abs(winkel); |
| } |
| else m = +1; |
| n =1; |
| // Quadranten auswerten |
| if ((winkel > 90 ) && (winkel <= 180)) winkel = 180 - winkel; |
| else if ((winkel > 180 ) && (winkel <= 270)) |
| { |
| winkel = winkel -180; |
| n = -1; |
| } |
| else if ((winkel > 270) && (winkel <= 360)) |
| { |
| winkel = 360 - winkel; |
| n = -1; |
| } |
| // else //0 - 90 Grad |
| winkel = pgm_read_word(&pgm_sinus[winkel]); |
| return (winkel*m*n); |
| } |
| // Aus x,y und Winkel Distanz ermitteln |
| long get_dist(signed int x, signed int y, signed int phi) |
| { |
| long dist; |
| if (abs(x) > abs(y) ) |
| { |
| dist = (long) x; //Groesseren Wert wegen besserer Genauigkeit nehmen |
| dist = abs((dist *1000) / (long) sin_i(phi)); |
| } |
| else |
| { |
| dist = (long) y; |
| dist = abs((dist *1000) / (long) cos_i(phi)); |
| } |
| return dist; |
| } |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/math.h |
|---|
| 0,0 → 1,11 |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Peter Muehlenbrock |
| // Definitionen fuer Modul math |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| #include "main.h" |
| extern signed int sin_i(signed int winkel); |
| extern signed int cos_i(signed int winkel); |
| extern signed int arctan_i(signed int x, signed int y); |
| extern long get_dist(signed int x, signed int y, signed int phi); |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/menu.c |
|---|
| 0,0 → 1,127 |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Copyright (c) 04.2007 Holger Buss |
| // + only for non-profit use |
| // + www.MikroKopter.com |
| // + see the File "License.txt" for further Informations |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| #include "main.h" |
| unsigned int TestInt = 0; |
| #define ARRAYGROESSE 10 |
| unsigned char Array[ARRAYGROESSE] = {1,2,3,4,5,6,7,8,9,10}; |
| char DisplayBuff[80] = "Hallo Welt"; |
| unsigned char DispPtr = 0; |
| unsigned char RemoteTasten = 0; |
| #define KEY1 0x01 |
| #define KEY2 0x02 |
| #define KEY3 0x04 |
| #define KEY4 0x08 |
| #define KEY5 0x10 |
| void LcdClear(void) |
| { |
| unsigned char i; |
| for(i=0;i<80;i++) DisplayBuff[i] = ' '; |
| } |
| void Menu(void) |
| { |
| static unsigned char MaxMenue = 10,MenuePunkt=0; |
| if(RemoteTasten & KEY1) { if(MenuePunkt) MenuePunkt--; else MenuePunkt = MaxMenue; LcdClear(); RemotePollDisplayLine = -1; } |
| if(RemoteTasten & KEY2) { MenuePunkt++; LcdClear(); RemotePollDisplayLine = -1;} |
| if((RemoteTasten & KEY1) && (RemoteTasten & KEY2)) MenuePunkt = 0; |
| LCD_printfxy(17,0,"[%i]",MenuePunkt); |
| switch(MenuePunkt) |
| { |
| case 0: |
| LCD_printfxy(0,0,"++ MikroKopter ++"); |
| LCD_printfxy(0,1,"HW:V%d.%d SW:%d.%d%c",PlatinenVersion/10,PlatinenVersion%10,VERSION_HAUPTVERSION, VERSION_NEBENVERSION,VERSION_INDEX+'a'); |
| LCD_printfxy(0,2,"Setting: %d ",GetActiveParamSetNumber()); |
| LCD_printfxy(0,3,"(c) Holger Buss"); |
| // if(RemoteTasten & KEY3) TestInt--; |
| // if(RemoteTasten & KEY4) TestInt++; |
| break; |
| case 1: |
| if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG) |
| { |
| LCD_printfxy(0,0,"Hoehe: %5i",HoehenWert); |
| LCD_printfxy(0,1,"SollHoehe: %5i",SollHoehe); |
| LCD_printfxy(0,2,"Luftdruck: %5i",MessLuftdruck); |
| LCD_printfxy(0,3,"Off : %5i",DruckOffsetSetting); |
| } |
| else |
| { |
| LCD_printfxy(0,1,"Keine "); |
| LCD_printfxy(0,2,"Höhenregelung"); |
| } |
| break; |
| case 2: |
| LCD_printfxy(0,0,"akt. Lage"); |
| LCD_printfxy(0,1,"Nick: %5i",IntegralNick/1024); |
| LCD_printfxy(0,2,"Roll: %5i",IntegralRoll/1024); |
| LCD_printfxy(0,3,"Kompass: %5i",KompassValue); |
| break; |
| case 3: |
| LCD_printfxy(0,0,"K1:%4i K2:%4i ",PPM_in[1],PPM_in[2]); |
| LCD_printfxy(0,1,"K3:%4i K4:%4i ",PPM_in[3],PPM_in[4]); |
| LCD_printfxy(0,2,"K5:%4i K6:%4i ",PPM_in[5],PPM_in[6]); |
| LCD_printfxy(0,3,"K7:%4i K8:%4i ",PPM_in[7],PPM_in[8]); |
| break; |
| case 4: |
| LCD_printfxy(0,0,"Ni:%4i Ro:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_NICK]],PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]); |
| LCD_printfxy(0,1,"Gs:%4i Gi:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_GAS]],PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]); |
| LCD_printfxy(0,2,"P1:%4i P2:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]],PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]]); |
| LCD_printfxy(0,3,"P3:%4i P4:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]],PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]]); |
| break; |
| case 5: |
| LCD_printfxy(0,0,"Gyro - Sensor"); |
| if(PlatinenVersion == 10) |
| { |
| LCD_printfxy(0,1,"Nick %4i (%3i)",AdWertNick - AdNeutralNick, AdNeutralNick); |
| LCD_printfxy(0,2,"Roll %4i (%3i)",AdWertRoll - AdNeutralRoll, AdNeutralRoll); |
| LCD_printfxy(0,3,"Gier %4i (%3i)",MesswertGier, AdNeutralGier); |
| } |
| else |
| { |
| LCD_printfxy(0,1,"Nick %4i (%3i)",AdWertNick - AdNeutralNick, AdNeutralNick/2); |
| LCD_printfxy(0,2,"Roll %4i (%3i)",AdWertRoll - AdNeutralRoll, AdNeutralRoll/2); |
| LCD_printfxy(0,3,"Gier %4i (%3i)",MesswertGier, AdNeutralGier/2); |
| } |
| break; |
| case 6: |
| LCD_printfxy(0,0,"ACC - Sensor"); |
| LCD_printfxy(0,1,"Nick %4i (%3i)",AdWertAccNick,NeutralAccX); |
| LCD_printfxy(0,2,"Roll %4i (%3i)",AdWertAccRoll,NeutralAccY); |
| LCD_printfxy(0,3,"Hoch %4i (%3i)",Mittelwert_AccHoch/*accumulate_AccHoch / messanzahl_AccHoch*/,(int)NeutralAccZ); |
| break; |
| case 7: |
| LCD_printfxy(0,1,"Spannung: %5i",UBat); |
| LCD_printfxy(0,2,"Empf.Pegel:%5i",SenderOkay); |
| break; |
| case 8: |
| LCD_printfxy(0,0,"Kompass "); |
| LCD_printfxy(0,1,"Richtung: %5i",KompassRichtung); |
| LCD_printfxy(0,2,"Messwert: %5i",KompassValue); |
| LCD_printfxy(0,3,"Start: %5i",KompassStartwert); |
| break; |
| case 9: |
| LCD_printfxy(0,0,"Poti1: %3i",Poti1); |
| LCD_printfxy(0,1,"Poti2: %3i",Poti2); |
| LCD_printfxy(0,2,"Poti3: %3i",Poti3); |
| LCD_printfxy(0,3,"Poti4: %3i",Poti4); |
| break; |
| case 10: |
| LCD_printfxy(0,0,"Servo " ); |
| LCD_printfxy(0,1,"Setpoint %3i",Parameter_ServoNickControl); |
| LCD_printfxy(0,2,"Stellung: %3i",ServoValue); |
| LCD_printfxy(0,3,"Range:%3i-%3i",EE_Parameter.ServoNickMin,EE_Parameter.ServoNickMax); |
| break; |
| default: MaxMenue = MenuePunkt - 1; |
| MenuePunkt = 0; |
| break; |
| } |
| RemoteTasten = 0; |
| } |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/menu.h |
|---|
| 0,0 → 1,6 |
| extern void Menu(void); |
| extern void LcdClear(void); |
| extern char DisplayBuff[80]; |
| extern unsigned char DispPtr; |
| extern unsigned char RemoteTasten; |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/old_macros.h |
|---|
| 0,0 → 1,47 |
| /* |
| For backwards compatibility only. |
| Ingo Busker ingo@mikrocontroller.com |
| */ |
| #ifndef cbi |
| #define cbi(sfr, bit) (_SFR_BYTE(sfr) &= ~_BV(bit)) |
| #endif |
| #ifndef sbi |
| #define sbi(sfr, bit) (_SFR_BYTE(sfr) |= _BV(bit)) |
| #endif |
| #ifndef inb |
| #define inb(sfr) _SFR_BYTE(sfr) |
| #endif |
| #ifndef outb |
| #define outb(sfr, val) (_SFR_BYTE(sfr) = (val)) |
| #endif |
| #ifndef inw |
| #define inw(sfr) _SFR_WORD(sfr) |
| #endif |
| #ifndef outw |
| #define outw(sfr, val) (_SFR_WORD(sfr) = (val)) |
| #endif |
| #ifndef outp |
| #define outp(val, sfr) outb(sfr, val) |
| #endif |
| #ifndef inp |
| #define inp(sfr) inb(sfr) |
| #endif |
| #ifndef BV |
| #define BV(bit) _BV(bit) |
| #endif |
| #ifndef PRG_RDB |
| #define PRG_RDB pgm_read_byte |
| #endif |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/printf_P.c |
|---|
| 0,0 → 1,480 |
| // Die Funktion printf_P() unterliegt ihrer eigenen Lizenz und ist nicht von der Lizenz für den MikroKopter-Teil unterstellt |
| /* |
| Copyright (C) 1993 Free Software Foundation |
| This file is part of the GNU IO Library. This library is free |
| software; you can redistribute it and/or modify it under the |
| terms of the GNU General Public License as published by the |
| Free Software Foundation; either version 2, or (at your option) |
| any later version. |
| This library is distributed in the hope that it will be useful, |
| but WITHOUT ANY WARRANTY; without even the implied warranty of |
| MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| GNU General Public License for more details. |
| You should have received a copy of the GNU General Public License |
| along with this library; see the file COPYING. If not, write to the Free |
| Software Foundation, 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. |
| As a special exception, if you link this library with files |
| compiled with a GNU compiler to produce an executable, this does not cause |
| the resulting executable to be covered by the GNU General Public License. |
| This exception does not however invalidate any other reasons why |
| the executable file might be covered by the GNU General Public License. */ |
| /* |
| * Copyright (c) 1990 Regents of the University of California. |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions |
| * are met: |
| * 1. Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * 2. Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in the |
| * documentation and/or other materials provided with the distribution. |
| * 3. [rescinded 22 July 1999] |
| * 4. Neither the name of the University nor the names of its contributors |
| * may be used to endorse or promote products derived from this software |
| * without specific prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND |
| * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE |
| * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
| * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS |
| * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) |
| * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT |
| * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY |
| * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
| * SUCH DAMAGE. |
| */ |
| /****************************************************************************** |
| This file is a patched version of printf called _printf_P |
| It is made to work with avr-gcc for Atmel AVR MCUs. |
| There are some differences from standard printf: |
| 1. There is no floating point support (with fp the code is about 8K!) |
| 2. Return type is void |
| 3. Format string must be in program memory (by using macro printf this is |
| done automaticaly) |
| 4. %n is not implemented (just remove the comment around it if you need it) |
| 5. If LIGHTPRINTF is defined, the code is about 550 bytes smaller and the |
| folowing specifiers are disabled : |
| space # * . - + p s o O |
| 6. A function void uart_sendchar(char c) is used for output. The UART must |
| be initialized before using printf. |
| Alexander Popov |
| sasho@vip.orbitel.bg |
| ******************************************************************************/ |
| /* |
| * Actual printf innards. |
| * |
| * This code is large and complicated... |
| */ |
| #include <string.h> |
| #ifdef __STDC__ |
| #include <stdarg.h> |
| #else |
| #include <varargs.h> |
| #endif |
| #include "main.h" |
| //#define LIGHTPRINTF |
| char PrintZiel; |
| char Putchar(char zeichen) |
| { |
| if(PrintZiel == OUT_LCD) { DisplayBuff[DispPtr++] = zeichen; return(1);} |
| else return(uart_putchar(zeichen)); |
| } |
| void PRINT(const char * ptr, unsigned int len) |
| { |
| for(;len;len--) Putchar(*ptr++); |
| } |
| void PRINTP(const char * ptr, unsigned int len) |
| { |
| for(;len;len--) Putchar(pgm_read_byte(ptr++)); |
| } |
| void PAD_SP(signed char howmany) |
| { |
| for(;howmany>0;howmany--) Putchar(' '); |
| } |
| void PAD_0(signed char howmany) |
| { |
| for(;howmany>0;howmany--) Putchar('0'); |
| } |
| #define BUF 40 |
| /* |
| * Macros for converting digits to letters and vice versa |
| */ |
| #define to_digit(c) ((c) - '0') |
| #define is_digit(c) ((c)<='9' && (c)>='0') |
| #define to_char(n) ((n) + '0') |
| /* |
| * Flags used during conversion. |
| */ |
| #define LONGINT 0x01 /* long integer */ |
| #define LONGDBL 0x02 /* long double; unimplemented */ |
| #define SHORTINT 0x04 /* short integer */ |
| #define ALT 0x08 /* alternate form */ |
| #define LADJUST 0x10 /* left adjustment */ |
| #define ZEROPAD 0x20 /* zero (as opposed to blank) pad */ |
| #define HEXPREFIX 0x40 /* add 0x or 0X prefix */ |
| void _printf_P (char ziel,char const *fmt0, ...) /* Works with string from FLASH */ |
| { |
| va_list ap; |
| register const char *fmt; /* format string */ |
| register char ch; /* character from fmt */ |
| register int n; /* handy integer (short term usage) */ |
| register char *cp; /* handy char pointer (short term usage) */ |
| const char *fmark; /* for remembering a place in fmt */ |
| register unsigned char flags; /* flags as above */ |
| signed char width; /* width from format (%8d), or 0 */ |
| signed char prec; /* precision from format (%.3d), or -1 */ |
| char sign; /* sign prefix (' ', '+', '-', or \0) */ |
| unsigned long _ulong=0; /* integer arguments %[diouxX] */ |
| #define OCT 8 |
| #define DEC 10 |
| #define HEX 16 |
| unsigned char base; /* base for [diouxX] conversion */ |
| signed char dprec; /* a copy of prec if [diouxX], 0 otherwise */ |
| signed char dpad; /* extra 0 padding needed for integers */ |
| signed char fieldsz; /* field size expanded by sign, dpad etc */ |
| /* The initialization of 'size' is to suppress a warning that |
| 'size' might be used unitialized. It seems gcc can't |
| quite grok this spaghetti code ... */ |
| signed char size = 0; /* size of converted field or string */ |
| char buf[BUF]; /* space for %c, %[diouxX], %[eEfgG] */ |
| char ox[2]; /* space for 0x hex-prefix */ |
| PrintZiel = ziel; // bestimmt, LCD oder UART |
| va_start(ap, fmt0); |
| fmt = fmt0; |
| /* |
| * Scan the format for conversions (`%' character). |
| */ |
| for (;;) { |
| for (fmark = fmt; (ch = pgm_read_byte(fmt)) != '\0' && ch != '%'; fmt++) |
| /* void */; |
| if ((n = fmt - fmark) != 0) { |
| PRINTP(fmark, n); |
| } |
| if (ch == '\0') |
| goto done; |
| fmt++; /* skip over '%' */ |
| flags = 0; |
| dprec = 0; |
| width = 0; |
| prec = -1; |
| sign = '\0'; |
| rflag: ch = PRG_RDB(fmt++); |
| reswitch: |
| #ifdef LIGHTPRINTF |
| if (ch=='o' || ch=='u' || (ch|0x20)=='x') { |
| #else |
| if (ch=='u' || (ch|0x20)=='x') { |
| #endif |
| if (flags&LONGINT) { |
| _ulong=va_arg(ap, unsigned long); |
| } else { |
| register unsigned int _d; |
| _d=va_arg(ap, unsigned int); |
| _ulong = flags&SHORTINT ? (unsigned long)(unsigned short)_d : (unsigned long)_d; |
| } |
| } |
| #ifndef LIGHTPRINTF |
| if(ch==' ') { |
| /* |
| * ``If the space and + flags both appear, the space |
| * flag will be ignored.'' |
| * -- ANSI X3J11 |
| */ |
| if (!sign) |
| sign = ' '; |
| goto rflag; |
| } else if (ch=='#') { |
| flags |= ALT; |
| goto rflag; |
| } else if (ch=='*'||ch=='-') { |
| if (ch=='*') { |
| /* |
| * ``A negative field width argument is taken as a |
| * - flag followed by a positive field width.'' |
| * -- ANSI X3J11 |
| * They don't exclude field widths read from args. |
| */ |
| if ((width = va_arg(ap, int)) >= 0) |
| goto rflag; |
| width = -width; |
| } |
| flags |= LADJUST; |
| flags &= ~ZEROPAD; /* '-' disables '0' */ |
| goto rflag; |
| } else if (ch=='+') { |
| sign = '+'; |
| goto rflag; |
| } else if (ch=='.') { |
| if ((ch = PRG_RDB(fmt++)) == '*') { |
| n = va_arg(ap, int); |
| prec = n < 0 ? -1 : n; |
| goto rflag; |
| } |
| n = 0; |
| while (is_digit(ch)) { |
| n = n*10 + to_digit(ch); |
| ch = PRG_RDB(fmt++); |
| } |
| prec = n < 0 ? -1 : n; |
| goto reswitch; |
| } else |
| #endif /* LIGHTPRINTF */ |
| if (ch=='0') { |
| /* |
| * ``Note that 0 is taken as a flag, not as the |
| * beginning of a field width.'' |
| * -- ANSI X3J11 |
| */ |
| if (!(flags & LADJUST)) |
| flags |= ZEROPAD; /* '-' disables '0' */ |
| goto rflag; |
| } else if (ch>='1' && ch<='9') { |
| n = 0; |
| do { |
| n = 10 * n + to_digit(ch); |
| ch = PRG_RDB(fmt++); |
| } while (is_digit(ch)); |
| width = n; |
| goto reswitch; |
| } else if (ch=='h') { |
| flags |= SHORTINT; |
| goto rflag; |
| } else if (ch=='l') { |
| flags |= LONGINT; |
| goto rflag; |
| } else if (ch=='c') { |
| *(cp = buf) = va_arg(ap, int); |
| size = 1; |
| sign = '\0'; |
| } else if (ch=='D'||ch=='d'||ch=='i') { |
| if(ch=='D') |
| flags |= LONGINT; |
| if (flags&LONGINT) { |
| _ulong=va_arg(ap, long); |
| } else { |
| register int _d; |
| _d=va_arg(ap, int); |
| _ulong = flags&SHORTINT ? (long)(short)_d : (long)_d; |
| } |
| if ((long)_ulong < 0) { |
| _ulong = -_ulong; |
| sign = '-'; |
| } |
| base = DEC; |
| goto number; |
| } else |
| /* |
| if (ch=='n') { |
| if (flags & LONGINT) |
| *va_arg(ap, long *) = ret; |
| else if (flags & SHORTINT) |
| *va_arg(ap, short *) = ret; |
| else |
| *va_arg(ap, int *) = ret; |
| continue; // no output |
| } else |
| */ |
| #ifndef LIGHTPRINTF |
| if (ch=='O'||ch=='o') { |
| if (ch=='O') |
| flags |= LONGINT; |
| base = OCT; |
| goto nosign; |
| } else if (ch=='p') { |
| /* |
| * ``The argument shall be a pointer to void. The |
| * value of the pointer is converted to a sequence |
| * of printable characters, in an implementation- |
| * defined manner.'' |
| * -- ANSI X3J11 |
| */ |
| /* NOSTRICT */ |
| _ulong = (unsigned int)va_arg(ap, void *); |
| base = HEX; |
| flags |= HEXPREFIX; |
| ch = 'x'; |
| goto nosign; |
| } else if (ch=='s') { // print a string from RAM |
| if ((cp = va_arg(ap, char *)) == NULL) { |
| cp=buf; |
| cp[0] = '('; |
| cp[1] = 'n'; |
| cp[2] = 'u'; |
| cp[4] = cp[3] = 'l'; |
| cp[5] = ')'; |
| cp[6] = '\0'; |
| } |
| if (prec >= 0) { |
| /* |
| * can't use strlen; can only look for the |
| * NUL in the first `prec' characters, and |
| * strlen() will go further. |
| */ |
| char *p = (char*)memchr(cp, 0, prec); |
| if (p != NULL) { |
| size = p - cp; |
| if (size > prec) |
| size = prec; |
| } else |
| size = prec; |
| } else |
| size = strlen(cp); |
| sign = '\0'; |
| } else |
| #endif /* LIGHTPRINTF */ |
| if(ch=='U'||ch=='u') { |
| if (ch=='U') |
| flags |= LONGINT; |
| base = DEC; |
| goto nosign; |
| } else if (ch=='X'||ch=='x') { |
| base = HEX; |
| /* leading 0x/X only if non-zero */ |
| if (flags & ALT && _ulong != 0) |
| flags |= HEXPREFIX; |
| /* unsigned conversions */ |
| nosign: sign = '\0'; |
| /* |
| * ``... diouXx conversions ... if a precision is |
| * specified, the 0 flag will be ignored.'' |
| * -- ANSI X3J11 |
| */ |
| number: if ((dprec = prec) >= 0) |
| flags &= ~ZEROPAD; |
| /* |
| * ``The result of converting a zero value with an |
| * explicit precision of zero is no characters.'' |
| * -- ANSI X3J11 |
| */ |
| cp = buf + BUF; |
| if (_ulong != 0 || prec != 0) { |
| register unsigned char _d,notlastdigit; |
| do { |
| notlastdigit=(_ulong>=base); |
| _d = _ulong % base; |
| if (_d<10) { |
| _d+='0'; |
| } else { |
| _d+='a'-10; |
| if (ch=='X') _d&=~0x20; |
| } |
| *--cp=_d; |
| _ulong /= base; |
| } while (notlastdigit); |
| #ifndef LIGHTPRINTF |
| // handle octal leading 0 |
| if (base==OCT && flags & ALT && *cp != '0') |
| *--cp = '0'; |
| #endif |
| } |
| size = buf + BUF - cp; |
| } else { //default |
| /* "%?" prints ?, unless ? is NUL */ |
| if (ch == '\0') |
| goto done; |
| /* pretend it was %c with argument ch */ |
| cp = buf; |
| *cp = ch; |
| size = 1; |
| sign = '\0'; |
| } |
| /* |
| * All reasonable formats wind up here. At this point, |
| * `cp' points to a string which (if not flags&LADJUST) |
| * should be padded out to `width' places. If |
| * flags&ZEROPAD, it should first be prefixed by any |
| * sign or other prefix; otherwise, it should be blank |
| * padded before the prefix is emitted. After any |
| * left-hand padding and prefixing, emit zeroes |
| * required by a decimal [diouxX] precision, then print |
| * the string proper, then emit zeroes required by any |
| * leftover floating precision; finally, if LADJUST, |
| * pad with blanks. |
| */ |
| /* |
| * compute actual size, so we know how much to pad. |
| */ |
| fieldsz = size; |
| dpad = dprec - size; |
| if (dpad < 0) |
| dpad = 0; |
| if (sign) |
| fieldsz++; |
| else if (flags & HEXPREFIX) |
| fieldsz += 2; |
| fieldsz += dpad; |
| /* right-adjusting blank padding */ |
| if ((flags & (LADJUST|ZEROPAD)) == 0) |
| PAD_SP(width - fieldsz); |
| /* prefix */ |
| if (sign) { |
| PRINT(&sign, 1); |
| } else if (flags & HEXPREFIX) { |
| ox[0] = '0'; |
| ox[1] = ch; |
| PRINT(ox, 2); |
| } |
| /* right-adjusting zero padding */ |
| if ((flags & (LADJUST|ZEROPAD)) == ZEROPAD) |
| PAD_0(width - fieldsz); |
| /* leading zeroes from decimal precision */ |
| PAD_0(dpad); |
| /* the string or number proper */ |
| PRINT(cp, size); |
| /* left-adjusting padding (always blank) */ |
| if (flags & LADJUST) |
| PAD_SP(width - fieldsz); |
| } |
| done: |
| va_end(ap); |
| } |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/printf_P.h |
|---|
| 0,0 → 1,19 |
| #ifndef _PRINTF_P_H_ |
| #define _PRINTF_P_H_ |
| #include <avr/pgmspace.h> |
| #define OUT_V24 0 |
| #define OUT_LCD 1 |
| void _printf_P (char, char const *fmt0, ...); |
| extern char PrintZiel; |
| #define printf_P(format, args...) _printf_P(OUT_V24,format , ## args) |
| #define printf(format, args...) _printf_P(OUT_V24,PSTR(format) , ## args) |
| #define LCD_printfxy(x,y,format, args...) { DispPtr = y * 20 + x; _printf_P(OUT_LCD,PSTR(format) , ## args);} |
| #define LCD_printf(format, args...) { _printf_P(OUT_LCD,PSTR(format) , ## args);} |
| #endif |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/rc.c |
|---|
| 0,0 → 1,84 |
| /*####################################################################################### |
| Decodieren eines RC Summen Signals |
| #######################################################################################*/ |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Copyright (c) 04.2007 Holger Buss |
| // + only for non-profit use |
| // + www.MikroKopter.com |
| // + see the File "License.txt" for further Informations |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| #include "rc.h" |
| #include "main.h" |
| volatile int PPM_in[11]; |
| volatile int PPM_diff[11]; // das diffenzierte Stick-Signal |
| volatile unsigned char NewPpmData = 1; |
| //############################################################################ |
| //zum decodieren des PPM-Signals wird Timer1 mit seiner Input |
| //Capture Funktion benutzt: |
| void rc_sum_init (void) |
| //############################################################################ |
| { |
| TCCR1B=(1<<CS11)|(1<<CS10)|(1<<ICES1)|(1<<ICNC1);//|(1 << WGM12); //timer1 prescale 64 |
| // PWM |
| //TCCR1A = (1 << COM1B1) | (1 << WGM11) | (1 << WGM10); |
| //TCCR1B |= (1 << WGM12); |
| //OCR1B = 55; |
| TIMSK1 |= _BV(ICIE1); |
| AdNeutralGier = 0; |
| AdNeutralRoll = 0; |
| AdNeutralNick = 0; |
| return; |
| } |
| //############################################################################ |
| //Diese Routine startet und inizialisiert den Timer für RC |
| SIGNAL(SIG_INPUT_CAPTURE1) |
| //############################################################################ |
| { |
| static unsigned int AltICR=0; |
| signed int signal = 0,tmp; |
| static int index; |
| signal = (unsigned int) ICR1 - AltICR; |
| AltICR = ICR1; |
| //Syncronisationspause? |
| // if((signal > (int) Parameter_UserParam2 * 10) && (signal < 8000)) |
| if((signal > 1100) && (signal < 8000)) |
| { |
| if(index >= 4) NewPpmData = 0; // Null bedeutet: Neue Daten |
| index = 1; |
| } |
| else |
| { |
| if(index < 10) |
| { |
| if((signal > 250) && (signal < 687)) |
| { |
| signal -= 466; |
| // Stabiles Signal |
| if(abs(signal - PPM_in[index]) < 6) { if(SenderOkay < 200) SenderOkay += 10;} |
| tmp = (3 * (PPM_in[index]) + signal) / 4; |
| // if(tmp > signal+1) tmp--; else |
| // if(tmp < signal-1) tmp++; |
| PPM_diff[index] = tmp - PPM_in[index]; |
| PPM_in[index] = tmp; |
| } |
| index++; |
| if(index == 5) PORTD |= 0x20; else PORTD &= ~0x20; // Servosignal an J3 anlegen |
| if(index == 6) PORTD |= 0x10; else PORTD &= ~0x10; // Servosignal an J4 anlegen |
| if(index == 7) PORTD |= 0x08; else PORTD &= ~0x08; // Servosignal an J5 anlegen |
| } |
| } |
| } |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/rc.h |
|---|
| 0,0 → 1,29 |
| /*####################################################################################### |
| Derkodieren eines RC Summen Signals |
| #######################################################################################*/ |
| #ifndef _RC_H |
| #define _RC_H |
| #if defined (__AVR_ATmega32__) |
| #define TIMER_TEILER CK64 |
| #define TIMER_RELOAD_VALUE 250 |
| #endif |
| #if defined (__AVR_ATmega644__) |
| //#define TIMER_TEILER CK64 |
| #define TIMER_RELOAD_VALUE 250 |
| //#define TIMER_TEILER CK256 // bei 20MHz |
| //#define TIMER_RELOAD_VALUE -78 // bei 20MHz |
| #endif |
| #define GAS PPM_in[2] |
| extern void rc_sum_init (void); |
| extern volatile int PPM_in[11]; |
| extern volatile int PPM_diff[11]; // das diffenzierte Stick-Signal |
| extern volatile unsigned char NewPpmData; |
| #endif //_RC_H |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/spi.c |
|---|
| 0,0 → 1,86 |
| // ######################## SPI - FlightCtrl ################### |
| #include "main.h" |
| struct str_ToNaviCtrl ToNaviCtrl; |
| struct str_FromNaviCtrl FromNaviCtrl; |
| unsigned char SPI_BufferIndex; |
| volatile unsigned char SPI_Buffer[sizeof(FromNaviCtrl)]; |
| unsigned char *Ptr_buffer = (unsigned char *) &ToNaviCtrl; |
| //------------------------------------------------------ |
| void SPI_MasterInit(void) |
| { |
| DDR_SPI |= (1<<DD_MOSI)|(1<<DD_SCK); // Set MOSI and SCK output, all others input |
| SLAVE_SELECT_DDR_PORT |= (1 << SPI_SLAVE_SELECT); |
| SPCR = (1<<SPE)|(1<<MSTR)|(1<<SPR1)|(0<<SPIE); // Enable SPI, Master, set clock rate fck/64 |
| SLAVE_SELECT_PORT |= (1 << SPI_SLAVE_SELECT); |
| } |
| //------------------------------------------------------ |
| void SPI_StartTransmitPacket(void) |
| { |
| if ((SLAVE_SELECT_PORT & (1 << SPI_SLAVE_SELECT)) == 0) return; // transfer of prev. packet not completed |
| SLAVE_SELECT_PORT &= ~(1 << SPI_SLAVE_SELECT); // SelectSlave |
| UpdateSPI_Buffer(); // update buffer |
| SPI_BufferIndex = 1; |
| DebugOut.Analog[16]++; |
| // -- Debug-Output --- |
| cli(); |
| DebugOut.Analog[20] = FromNaviCtrl.Comp; |
| DebugOut.Analog[21] = FromNaviCtrl.GPS_Nick; |
| DebugOut.Analog[22] = FromNaviCtrl.GPS_Roll; |
| DebugOut.Analog[23] = FromNaviCtrl.CompassValue; |
| sei(); |
| //---- |
| SPDR = ToNaviCtrl.Comp; // Start transmission |
| } |
| //------------------------------------------------------ |
| //SIGNAL(SIG_SPI) |
| void SPI_TransmitByte(void) |
| { |
| if (!(SPSR & (1 << SPIF))) return; |
| if (SPI_BufferIndex < sizeof(FromNaviCtrl)) |
| { SPI_Buffer[SPI_BufferIndex]= SPDR; // get data |
| //if(SPDR!= 0x00) DebugOut.Analog[19]++; ; |
| } |
| if (SPI_BufferIndex < sizeof(ToNaviCtrl)) |
| { SPDR = Ptr_buffer[SPI_BufferIndex]; |
| } |
| else |
| { |
| unsigned char *ptr = (unsigned char *)&FromNaviCtrl; |
| unsigned char i; |
| SLAVE_SELECT_PORT |= (1 << SPI_SLAVE_SELECT); // DeselectSlave |
| memcpy(ptr, (unsigned char *) SPI_Buffer, sizeof(SPI_Buffer)); |
| } |
| SPI_BufferIndex++; |
| } |
| //------------------------------------------------------ |
| void UpdateSPI_Buffer(void) |
| { |
| cli(); |
| ToNaviCtrl.Comp = SPI_PROTOCOL_COMP; |
| ToNaviCtrl.IntegralNick = (int) (IntegralNick >> 4); |
| ToNaviCtrl.IntegralRoll = (int) (IntegralRoll >> 4); |
| ToNaviCtrl.StickNick = (char) StickNick; |
| ToNaviCtrl.StickRoll = (char) StickRoll; |
| ToNaviCtrl.StickGier = (char) StickGier; |
| sei(); |
| } |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/spi.h |
|---|
| 0,0 → 1,46 |
| // ######################## SPI - FlightCtrl ################### |
| #ifndef _SPI_H |
| #define _SPI_H |
| #define SPI_PROTOCOL_COMP 1 |
| //----------------------------------------- |
| #define DDR_SPI DDRB |
| #define DD_SS PB4 |
| #define DD_SCK PB7 |
| #define DD_MOSI PB5 |
| #define DD_MISO PB6 |
| #define SLAVE_SELECT_DDR_PORT DDRC |
| #define SLAVE_SELECT_PORT PORTC |
| #define SPI_SLAVE_SELECT PC5 |
| struct str_ToNaviCtrl |
| { |
| unsigned char Comp; |
| int IntegralNick; |
| int IntegralRoll; |
| char StickNick,StickRoll,StickGier; |
| }; |
| struct str_FromNaviCtrl |
| { |
| unsigned char Comp; |
| int GPS_Nick; |
| int GPS_Roll; |
| int CompassValue; |
| }; |
| extern struct str_ToNaviCtrl ToNaviCtrl; |
| extern struct str_FromNaviCtrl FromNaviCtrl; |
| extern void SPI_MasterInit(void); |
| extern void SPI_StartTransmitPacket(void); |
| extern void UpdateSPI_Buffer(void); |
| extern void SPI_TransmitByte(void); |
| #endif |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/timer0.c |
|---|
| 0,0 → 1,191 |
| #include "main.h" |
| volatile unsigned int CountMilliseconds = 0; |
| volatile static unsigned int tim_main; |
| volatile unsigned char UpdateMotor = 0; |
| volatile unsigned int cntKompass = 0; |
| volatile unsigned int beeptime = 0; |
| unsigned int BeepMuster = 0xffff; |
| int ServoValue = 0; |
| //Salvo 8.9.2007 |
| volatile uint8_t Kompass_Neuer_Wert= 0; |
| volatile unsigned int Kompass_Value_Old = 0; |
| // Salvo End |
| //Salvo 21.9.2007 |
| short unsigned int Kompass_present= 0; //>0 bedeutet dass der Kompass vorhanden ist |
| // Salvo End |
| enum { |
| STOP = 0, |
| CK = 1, |
| CK8 = 2, |
| CK64 = 3, |
| CK256 = 4, |
| CK1024 = 5, |
| T0_FALLING_EDGE = 6, |
| T0_RISING_EDGE = 7 |
| }; |
| // Aenderungen von Peter Muehlenbrock ("Salvo") Stand 21.9.2007 |
| /* |
| Ersatzkompass abgeleitet aus Magnetkompass und Giergyro fuer nahezu neigungsubhaengige Kompassfunktion |
| */ |
| SIGNAL (SIG_OVERFLOW0) // 8kHz |
| { |
| static unsigned char cnt_1ms = 1,cnt = 0; |
| unsigned char pieper_ein = 0; |
| // TCNT0 -= 250;//TIMER_RELOAD_VALUE; |
| if(!cnt--) |
| { |
| if (Kompass_present > 0) Kompass_present--; //Runterzaehlen. Wenn 0 ist der Kompass nicht vorhanden |
| cnt = 9; |
| cnt_1ms++; |
| cnt_1ms %= 2; |
| if(!cnt_1ms) UpdateMotor = 1; |
| CountMilliseconds++; |
| } |
| if(beeptime > 1) |
| { |
| beeptime--; |
| if(beeptime & BeepMuster) |
| { |
| pieper_ein = 1; |
| } |
| else pieper_ein = 0; |
| } |
| else |
| { |
| pieper_ein = 0; |
| BeepMuster = 0xffff; |
| } |
| if(pieper_ein) |
| { |
| if(PlatinenVersion == 10) PORTD |= (1<<2); // Speaker an PORTD.2 |
| else PORTC |= (1<<7); // Speaker an PORTC.7 |
| } |
| else |
| { |
| if(PlatinenVersion == 10) PORTD &= ~(1<<2); |
| else PORTC &= ~(1<<7); |
| } |
| // if(EE_Parameter.GlobalConfig & CFG_KOMPASS_AKTIV) |
| { |
| if(PINC & 0x10) |
| { |
| cntKompass++; |
| } |
| else |
| { |
| if((cntKompass) && (cntKompass < 4000)) |
| { |
| // Salvo Kompassoffset 30.8.2007 und 21.9.2007 *********** |
| Kompass_present = 255; |
| // Kompass_Value_Old = KompassValue; |
| KompassValue = cntKompass -KOMPASS_OFFSET; |
| if (KompassValue < 0) |
| { |
| KompassValue += 360; |
| } |
| if (KompassValue >= 360) |
| { |
| KompassValue -= 360; |
| } |
| // Salvo End |
| } |
| // if(cntKompass < 10) cntKompass = 10; |
| // KompassValue = (unsigned long)((unsigned long)(cntKompass-10)*720L + 1L) / 703L; |
| KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180; |
| //Salvo 13.9.2007 Ok Erkennung des Magnetkompasses |
| Kompass_Neuer_Wert = 1; |
| // Salvo End |
| cntKompass = 0; |
| } |
| } |
| } |
| void Timer_Init(void) |
| { |
| tim_main = SetDelay(10); |
| TCCR0B = CK8; |
| TCCR0A = (1<<COM0A1)|(1<<COM0B1)|3;//fast PWM |
| OCR0A = 0; |
| OCR0B = 120; |
| TCNT0 = (unsigned char)-TIMER_RELOAD_VALUE; // reload |
| //OCR1 = 0x00; |
| TCCR2A=(1<<COM2A1)|(1<<COM2A0)|3; |
| TCCR2B=(0<<CS20)|(1<<CS21)|(1<<CS22); |
| // TIMSK2 |= _BV(TOIE2); |
| TIMSK2 |= _BV(OCIE2A); |
| TIMSK0 |= _BV(TOIE0); |
| OCR2A = 10; |
| TCNT2 = 0; |
| } |
| // ----------------------------------------------------------------------- |
| unsigned int SetDelay (unsigned int t) |
| { |
| // TIMSK0 &= ~_BV(TOIE0); |
| return(CountMilliseconds + t + 1); |
| // TIMSK0 |= _BV(TOIE0); |
| } |
| // ----------------------------------------------------------------------- |
| char CheckDelay(unsigned int t) |
| { |
| // TIMSK0 &= ~_BV(TOIE0); |
| return(((t - CountMilliseconds) & 0x8000) >> 9); |
| // TIMSK0 |= _BV(TOIE0); |
| } |
| // ----------------------------------------------------------------------- |
| void Delay_ms(unsigned int w) |
| { |
| unsigned int akt; |
| akt = SetDelay(w); |
| while (!CheckDelay(akt)); |
| } |
| void Delay_ms_Mess(unsigned int w) |
| { |
| unsigned int akt; |
| akt = SetDelay(w); |
| while (!CheckDelay(akt)) ANALOG_ON; |
| } |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Servo ansteuern |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| SIGNAL(SIG_OUTPUT_COMPARE2A) |
| { |
| static unsigned char timer = 10; |
| if(!timer--) |
| { |
| TCCR2A=(1<<COM2A1)|(0<<COM2A0)|3; |
| ServoValue = Parameter_ServoNickControl; |
| if(EE_Parameter.ServoNickCompInvert & 0x01) ServoValue += ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512; |
| else ServoValue -= ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512; |
| if(ServoValue < EE_Parameter.ServoNickMin) ServoValue = EE_Parameter.ServoNickMin; |
| else if(ServoValue > EE_Parameter.ServoNickMax) ServoValue = EE_Parameter.ServoNickMax; |
| OCR2A = ServoValue;// + 75; |
| timer = EE_Parameter.ServoNickRefresh; |
| } |
| else |
| { |
| TCCR2A =3; |
| PORTD&=~0x80; |
| } |
| } |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/timer0.h |
|---|
| 0,0 → 1,26 |
| #define TIMER_TEILER CK8 |
| #define TIMER_RELOAD_VALUE 250 |
| // Salvo Kompassoffset 31.8.2007 *********** |
| #define KOMPASS_OFFSET 135 // Winkel zwischen Nordachse Kopter und Nordachse Kompass |
| // Salvo End |
| void Timer_Init(void); |
| void Delay_ms(unsigned int); |
| void Delay_ms_Mess(unsigned int); |
| unsigned int SetDelay (unsigned int t); |
| char CheckDelay (unsigned int t); |
| extern volatile unsigned int CountMilliseconds; |
| extern volatile unsigned char UpdateMotor; |
| extern volatile unsigned int beeptime; |
| extern volatile unsigned int cntKompass; |
| extern int ServoValue; |
| extern unsigned int BeepMuster; |
| //Salvo 21.9.2007 |
| extern volatile uint8_t Kompass_Neuer_Wert; |
| extern volatile unsigned int Kompass_Value_Old; |
| extern unsigned short int Kompass_present; |
| // Salvo End |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/twimaster.c |
|---|
| 0,0 → 1,152 |
| /*############################################################################ |
| ############################################################################*/ |
| #include "main.h" |
| unsigned char twi_state = 0; |
| unsigned char motor = 0; |
| unsigned char motorread = 0; |
| unsigned char motor_rx[8]; |
| //############################################################################ |
| //Initzialisieren der I2C (TWI) Schnittstelle |
| void i2c_init(void) |
| //############################################################################ |
| { |
| TWSR = 0; |
| TWBR = ((SYSCLK/SCL_CLOCK)-16)/2; |
| } |
| //############################################################################ |
| //Start I2C |
| char i2c_start(void) |
| //############################################################################ |
| { |
| TWCR = (1<<TWSTA) | (1<<TWEN) | (1<<TWINT) | (1<<TWIE); |
| return(0); |
| } |
| //############################################################################ |
| //Start I2C |
| void i2c_stop(void) |
| //############################################################################ |
| { |
| TWCR = (1<<TWEN) | (1<<TWSTO) | (1<<TWINT); |
| } |
| void i2c_reset(void) |
| //############################################################################ |
| { |
| i2c_stop(); |
| twi_state = 0; |
| motor = TWDR; |
| motor = 0; |
| TWCR = 0x80; |
| TWAMR = 0; |
| TWAR = 0; |
| TWDR = 0; |
| TWSR = 0; |
| TWBR = 0; |
| i2c_init(); |
| i2c_start(); |
| i2c_write_byte(0); |
| } |
| //############################################################################ |
| //Start I2C |
| char i2c_write_byte(char byte) |
| //############################################################################ |
| { |
| TWSR = 0x00; |
| TWDR = byte; |
| TWCR = (1<<TWINT) | (1<<TWEN) | (1<<TWIE); |
| return(0); |
| } |
| //############################################################################ |
| //Start I2C |
| SIGNAL (TWI_vect) |
| //############################################################################ |
| { |
| switch (twi_state++) |
| { |
| case 0: |
| i2c_write_byte(0x52+(motor*2)); |
| break; |
| case 1: |
| switch(motor++) |
| { |
| case 0: |
| i2c_write_byte(Motor_Vorne); |
| break; |
| case 1: |
| i2c_write_byte(Motor_Hinten); |
| break; |
| case 2: |
| i2c_write_byte(Motor_Rechts); |
| break; |
| case 3: |
| i2c_write_byte(Motor_Links); |
| break; |
| } |
| break; |
| case 2: |
| i2c_stop(); |
| if (motor<4) twi_state = 0; |
| else motor = 0; |
| i2c_start(); |
| break; |
| //Liest Daten von Motor |
| case 3: |
| i2c_write_byte(0x53+(motorread*2)); |
| break; |
| case 4: |
| switch(motorread) |
| { |
| case 0: |
| i2c_write_byte(Motor_Vorne); |
| break; |
| case 1: |
| i2c_write_byte(Motor_Hinten); |
| break; |
| case 2: |
| i2c_write_byte(Motor_Rechts); |
| break; |
| case 3: |
| i2c_write_byte(Motor_Links); |
| break; |
| } |
| break; |
| case 5: //1 Byte vom Motor lesen |
| motor_rx[motorread] = TWDR; |
| case 6: |
| switch(motorread) |
| { |
| case 0: |
| i2c_write_byte(Motor_Vorne); |
| break; |
| case 1: |
| i2c_write_byte(Motor_Hinten); |
| break; |
| case 2: |
| i2c_write_byte(Motor_Rechts); |
| break; |
| case 3: |
| i2c_write_byte(Motor_Links); |
| break; |
| } |
| break; |
| case 7: //2 Byte vom Motor lesen |
| motor_rx[motorread+4] = TWDR; |
| motorread++; |
| if (motorread>3) motorread=0; |
| i2c_stop(); |
| I2CTimeout = 10; |
| twi_state = 0; |
| } |
| TWCR |= 0x80; |
| } |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/twimaster.h |
|---|
| 0,0 → 1,33 |
| /*############################################################################ |
| ############################################################################*/ |
| #ifndef _I2C_MASTER_H |
| #define _I2C_MASTER_H |
| //############################################################################ |
| // I2C Konstanten |
| #define SCL_CLOCK 200000L |
| #define I2C_TIMEOUT 30000 |
| #define I2C_START 0x08 |
| #define I2C_REPEATED_START 0x10 |
| #define I2C_TX_SLA_ACK 0x18 |
| #define I2C_TX_DATA_ACK 0x28 |
| #define I2C_RX_SLA_ACK 0x40 |
| #define I2C_RX_DATA_ACK 0x50 |
| //############################################################################ |
| extern unsigned char twi_state; |
| extern unsigned char motor; |
| extern unsigned char motorread; |
| extern unsigned char motor_rx[8]; |
| void i2c_reset(void); |
| extern void i2c_init (void); // I2C initialisieren |
| extern char i2c_start (void); // Start I2C |
| extern void i2c_stop (void); // Stop I2C |
| extern char i2c_write_byte (char byte); // 1 Byte schreiben |
| extern void i2c_reset(void); |
| #endif |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/uart.c |
|---|
| 0,0 → 1,398 |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // + Copyright (c) 04.2007 Holger Buss |
| // + only for non-profit use |
| // + www.MikroKopter.com |
| // + see the File "License.txt" for further Informations |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| #include "main.h" |
| #include "uart.h" |
| unsigned char DebugGetAnforderung = 0,DebugDisplayAnforderung = 0,DebugDataAnforderung = 0,GetVersionAnforderung = 0; |
| unsigned volatile char SioTmp = 0; |
| unsigned volatile char SendeBuffer[MAX_SENDE_BUFF]; |
| unsigned volatile char RxdBuffer[MAX_EMPFANGS_BUFF]; |
| unsigned volatile char NMEABuffer[MAX_EMPFANGS_BUFF]; |
| unsigned volatile char NeuerDatensatzEmpfangen = 0; |
| unsigned volatile char NeueKoordinateEmpfangen = 0; |
| unsigned volatile char UebertragungAbgeschlossen = 1; |
| unsigned volatile char CntCrcError = 0; |
| unsigned volatile char AnzahlEmpfangsBytes = 0; |
| unsigned volatile char PC_DebugTimeout = 0; |
| unsigned char RemotePollDisplayLine = 0; |
| unsigned char NurKanalAnforderung = 0; |
| unsigned char DebugTextAnforderung = 255; |
| unsigned char PcZugriff = 100; |
| unsigned char MotorTest[4] = {0,0,0,0}; |
| unsigned char DubWiseKeys[3] = {0,0,0}; |
| unsigned char MeineSlaveAdresse; |
| struct str_DebugOut DebugOut; |
| struct str_Debug DebugIn; |
| struct str_VersionInfo VersionInfo; |
| int Debug_Timer; |
| //Salvo 26.10.2007 |
| int dataset_cnt=0; //Zaehlt die uebertragenen Debugdaten |
| //Salvo End |
| const unsigned char ANALOG_TEXT[32][16] = |
| { |
| //1234567890123456 |
| "IntegralNick ", //0 |
| "IntegralRoll ", |
| "AccNick ", |
| "AccRoll ", |
| "GyroGier ", |
| "HoehenWert ", //5 |
| "AccZ ", |
| "Gas ", |
| "KompassValue ", |
| "Ersatzkompass ", |
| "Usr_Par1 ", //10 |
| "Usr_par3 ", |
| "Motor_Vorne ", |
| "Motor_Hinten ", |
| "Motor_Links ", |
| "Motor_Rechts ", //15 |
| "Index ", |
| "UBat ", |
| "Messwert_Nick ", |
| "Messwert_Roll ", |
| "Messwert_Gier ", //20 |
| "Stick_Nick ", |
| "Stick_Roll ", |
| "Stick_Gier ", |
| "GPS_Nick ", |
| "GPS_Roll ", //25 |
| "utm_east ", |
| "utm_north ", |
| "utm_alt ", |
| "gps_state ", |
| "GPS_dist_2trgt ", //30 |
| "GyroGier_Comp " |
| }; |
| //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| //++ Sende-Part der Datenübertragung |
| //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| SIGNAL(INT_VEC_TX) |
| { |
| static unsigned int ptr = 0; |
| unsigned char tmp_tx; |
| if(!UebertragungAbgeschlossen) |
| { |
| ptr++; // die [0] wurde schon gesendet |
| tmp_tx = SendeBuffer[ptr]; |
| if((tmp_tx == '\r') || (ptr == MAX_SENDE_BUFF)) |
| { |
| ptr = 0; |
| UebertragungAbgeschlossen = 1; |
| } |
| UDR = tmp_tx; |
| } |
| else ptr = 0; |
| } |
| //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| //++ Empfangs-Part der Datenübertragung, incl. CRC-Auswertung |
| //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| SIGNAL(INT_VEC_RX) |
| { |
| static unsigned int crc; |
| static unsigned char crc1,crc2,buf_ptr; |
| static unsigned char UartState = 0; |
| unsigned char CrcOkay = 0; |
| SioTmp = UDR; |
| //Salvo 11.9.2007 GPS Daten holen |
| Get_Ublox_Msg(SioTmp); // Daten vom GPS Modul holen |
| // Salvo End |
| if(buf_ptr >= MAX_EMPFANGS_BUFF) UartState = 0; |
| if(SioTmp == '\r' && UartState == 2) |
| { |
| UartState = 0; |
| crc -= RxdBuffer[buf_ptr-2]; |
| crc -= RxdBuffer[buf_ptr-1]; |
| crc %= 4096; |
| crc1 = '=' + crc / 64; |
| crc2 = '=' + crc % 64; |
| CrcOkay = 0; |
| if((crc1 == RxdBuffer[buf_ptr-2]) && (crc2 == RxdBuffer[buf_ptr-1])) CrcOkay = 1; else { CrcOkay = 0; CntCrcError++;}; |
| if(!NeuerDatensatzEmpfangen && CrcOkay) // Datensatz schon verarbeitet |
| { |
| NeuerDatensatzEmpfangen = 1; |
| AnzahlEmpfangsBytes = buf_ptr; |
| RxdBuffer[buf_ptr] = '\r'; |
| if(RxdBuffer[2] == 'R') wdt_enable(WDTO_250MS); // Reset-Commando |
| } |
| } |
| else |
| switch(UartState) |
| { |
| case 0: |
| if(SioTmp == '#' && !NeuerDatensatzEmpfangen) UartState = 1; // Startzeichen und Daten schon verarbeitet |
| buf_ptr = 0; |
| RxdBuffer[buf_ptr++] = SioTmp; |
| crc = SioTmp; |
| break; |
| case 1: // Adresse auswerten |
| UartState++; |
| RxdBuffer[buf_ptr++] = SioTmp; |
| crc += SioTmp; |
| break; |
| case 2: // Eingangsdaten sammeln |
| RxdBuffer[buf_ptr] = SioTmp; |
| if(buf_ptr < MAX_EMPFANGS_BUFF) buf_ptr++; |
| else UartState = 0; |
| crc += SioTmp; |
| break; |
| default: |
| UartState = 0; |
| break; |
| } |
| } |
| // -------------------------------------------------------------------------- |
| void AddCRC(unsigned int wieviele) |
| { |
| unsigned int tmpCRC = 0,i; |
| for(i = 0; i < wieviele;i++) |
| { |
| tmpCRC += SendeBuffer[i]; |
| } |
| tmpCRC %= 4096; |
| SendeBuffer[i++] = '=' + tmpCRC / 64; |
| SendeBuffer[i++] = '=' + tmpCRC % 64; |
| SendeBuffer[i++] = '\r'; |
| UebertragungAbgeschlossen = 0; |
| UDR = SendeBuffer[0]; |
| } |
| // -------------------------------------------------------------------------- |
| void SendOutData(unsigned char cmd,unsigned char modul, unsigned char *snd, unsigned char len) |
| { |
| unsigned int pt = 0; |
| unsigned char a,b,c; |
| unsigned char ptr = 0; |
| SendeBuffer[pt++] = '#'; // Startzeichen |
| SendeBuffer[pt++] = modul; // Adresse (a=0; b=1,...) |
| SendeBuffer[pt++] = cmd; // Commando |
| while(len) |
| { |
| if(len) { a = snd[ptr++]; len--;} else a = 0; |
| if(len) { b = snd[ptr++]; len--;} else b = 0; |
| if(len) { c = snd[ptr++]; len--;} else c = 0; |
| SendeBuffer[pt++] = '=' + (a >> 2); |
| SendeBuffer[pt++] = '=' + (((a & 0x03) << 4) | ((b & 0xf0) >> 4)); |
| SendeBuffer[pt++] = '=' + (((b & 0x0f) << 2) | ((c & 0xc0) >> 6)); |
| SendeBuffer[pt++] = '=' + ( c & 0x3f); |
| } |
| AddCRC(pt); |
| } |
| // -------------------------------------------------------------------------- |
| void Decode64(unsigned char *ptrOut, unsigned char len, unsigned char ptrIn,unsigned char max) // Wohin mit den Daten; Wie lang; Wo im RxdBuffer |
| { |
| unsigned char a,b,c,d; |
| unsigned char ptr = 0; |
| unsigned char x,y,z; |
| while(len) |
| { |
| a = RxdBuffer[ptrIn++] - '='; |
| b = RxdBuffer[ptrIn++] - '='; |
| c = RxdBuffer[ptrIn++] - '='; |
| d = RxdBuffer[ptrIn++] - '='; |
| if(ptrIn > max - 2) break; // nicht mehr Daten verarbeiten, als empfangen wurden |
| x = (a << 2) | (b >> 4); |
| y = ((b & 0x0f) << 4) | (c >> 2); |
| z = ((c & 0x03) << 6) | d; |
| if(len--) ptrOut[ptr++] = x; else break; |
| if(len--) ptrOut[ptr++] = y; else break; |
| if(len--) ptrOut[ptr++] = z; else break; |
| } |
| } |
| // -------------------------------------------------------------------------- |
| void BearbeiteRxDaten(void) |
| { |
| if(!NeuerDatensatzEmpfangen) return; |
| // unsigned int tmp_int_arr1[1]; |
| // unsigned int tmp_int_arr2[2]; |
| // unsigned int tmp_int_arr3[3]; |
| unsigned char tmp_char_arr2[2]; |
| // unsigned char tmp_char_arr3[3]; |
| // unsigned char tmp_char_arr4[4]; |
| //if(!MotorenEin) |
| PcZugriff = 255; |
| switch(RxdBuffer[2]) |
| { |
| case 'a':// Texte der Analogwerte |
| Decode64((unsigned char *) &tmp_char_arr2[0],sizeof(tmp_char_arr2),3,AnzahlEmpfangsBytes); |
| DebugTextAnforderung = tmp_char_arr2[0]; |
| break; |
| case 'c':// Debugdaten incl. Externe IOs usw |
| Decode64((unsigned char *) &DebugIn,sizeof(DebugIn),3,AnzahlEmpfangsBytes); |
| /* for(unsigned char i=0; i<4;i++) |
| { |
| EE_CheckAndWrite(&EE_Buffer[EE_DEBUGWERTE + i*2], DebugIn.Analog[i]); |
| EE_CheckAndWrite(&EE_Buffer[EE_DEBUGWERTE + i*2 + 1], DebugIn.Analog[i] >> 8); |
| }*/ |
| RemoteTasten |= DebugIn.RemoteTasten; |
| DebugDataAnforderung = 1; |
| break; |
| case 'h':// x-1 Displayzeilen |
| Decode64((unsigned char *) &tmp_char_arr2[0],sizeof(tmp_char_arr2),3,AnzahlEmpfangsBytes); |
| RemoteTasten |= tmp_char_arr2[0]; |
| if(tmp_char_arr2[1] == 255) NurKanalAnforderung = 1; else NurKanalAnforderung = 0; // keine Displaydaten |
| DebugDisplayAnforderung = 1; |
| break; |
| case 't':// Motortest |
| Decode64((unsigned char *) &MotorTest[0],sizeof(MotorTest),3,AnzahlEmpfangsBytes); |
| break; |
| case 'k':// Keys von DubWise |
| Decode64((unsigned char *) &DubWiseKeys[0],sizeof(DubWiseKeys),3,AnzahlEmpfangsBytes); |
| break; |
| case 'v': // Version-Anforderung und Ausbaustufe |
| GetVersionAnforderung = 1; |
| break; |
| case 'g':// "Get"-Anforderung für Debug-Daten |
| // Bei Get werden die vom PC einstellbaren Werte vom PC zurückgelesen |
| DebugGetAnforderung = 1; |
| break; |
| case 'q':// "Get"-Anforderung für Settings |
| // Bei Get werden die vom PC einstellbaren Werte vom PC zurückgelesen |
| Decode64((unsigned char *) &tmp_char_arr2[0],sizeof(tmp_char_arr2),3,AnzahlEmpfangsBytes); |
| if(tmp_char_arr2[0] != 0xff) |
| { |
| if(tmp_char_arr2[0] > 5) tmp_char_arr2[0] = 5; |
| ReadParameterSet(tmp_char_arr2[0], (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE); |
| SendOutData('L' + tmp_char_arr2[0] -1,MeineSlaveAdresse,(unsigned char *) &EE_Parameter.Kanalbelegung[0],STRUCT_PARAM_LAENGE); |
| } |
| else |
| SendOutData('L' + GetActiveParamSetNumber()-1,MeineSlaveAdresse,(unsigned char *) &EE_Parameter.Kanalbelegung[0],STRUCT_PARAM_LAENGE); |
| break; |
| case 'l': |
| case 'm': |
| case 'n': |
| case 'o': |
| case 'p': // Parametersatz speichern |
| Decode64((unsigned char *) &EE_Parameter.Kanalbelegung[0],STRUCT_PARAM_LAENGE,3,AnzahlEmpfangsBytes); |
| WriteParameterSet(RxdBuffer[2] - 'l' + 1, (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE); |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACTIVE_SET], RxdBuffer[2] - 'l' + 1); // aktiven Datensatz merken |
| Umschlag180Nick = (long) EE_Parameter.WinkelUmschlagNick * 2500L; |
| Umschlag180Roll = (long) EE_Parameter.WinkelUmschlagRoll * 2500L; |
| Piep(GetActiveParamSetNumber()); |
| break; |
| } |
| // DebugOut.AnzahlZyklen = Debug_Timer_Intervall; |
| NeuerDatensatzEmpfangen = 0; |
| } |
| //############################################################################ |
| //Routine für die Serielle Ausgabe |
| int uart_putchar (char c) |
| //############################################################################ |
| { |
| if (c == '\n') |
| uart_putchar('\r'); |
| //Warten solange bis Zeichen gesendet wurde |
| loop_until_bit_is_set(USR, UDRE); |
| //Ausgabe des Zeichens |
| UDR = c; |
| return (0); |
| } |
| // -------------------------------------------------------------------------- |
| void WriteProgramData(unsigned int pos, unsigned char wert) |
| { |
| //if (ProgramLocation == IN_RAM) Buffer[pos] = wert; |
| // else eeprom_write_byte(&EE_Buffer[pos], wert); |
| // Buffer[pos] = wert; |
| } |
| //############################################################################ |
| //INstallation der Seriellen Schnittstelle |
| void UART_Init (void) |
| //############################################################################ |
| { |
| //Enable TXEN im Register UCR TX-Data Enable & RX Enable |
| UCR=(1 << TXEN) | (1 << RXEN); |
| // UART Double Speed (U2X) |
| USR |= (1<<U2X); |
| // RX-Interrupt Freigabe |
| UCSRB |= (1<<RXCIE); |
| // TX-Interrupt Freigabe |
| UCSRB |= (1<<TXCIE); |
| //Teiler wird gesetzt |
| UBRR=(SYSCLK / (BAUD_RATE * 8L) - 1); |
| //UBRR = 33; |
| //öffnet einen Kanal für printf (STDOUT) |
| //fdevopen (uart_putchar, 0); |
| //sbi(PORTD,4); |
| Debug_Timer = SetDelay(200); |
| } |
| //--------------------------------------------------------------------------------------------- |
| void DatenUebertragung(void) |
| { |
| static char dis_zeile = 0; |
| if(!UebertragungAbgeschlossen) return; |
| if(DebugGetAnforderung && UebertragungAbgeschlossen) // Bei Get werden die vom PC einstellbaren Werte vom PC zurückgelesen |
| { |
| SendOutData('G',MeineSlaveAdresse,(unsigned char *) &DebugIn,sizeof(DebugIn)); |
| DebugGetAnforderung = 0; |
| } |
| if((CheckDelay(Debug_Timer) || DebugDataAnforderung) && UebertragungAbgeschlossen) |
| { |
| SendOutData('D',MeineSlaveAdresse,(unsigned char *) &DebugOut,sizeof(DebugOut)); |
| DebugDataAnforderung = 0; |
| //Salvo 26.10.2007 Counter fuer Erkennung von fehlenden Daten per Bluetoothuebertragung |
| dataset_cnt++; |
| // Salvo End |
| Debug_Timer = SetDelay(MIN_DEBUG_INTERVALL); |
| } |
| if(DebugTextAnforderung != 255) // Texte für die Analogdaten |
| { |
| SendOutData('A',DebugTextAnforderung + '0',(unsigned char *) ANALOG_TEXT[DebugTextAnforderung],16); |
| DebugTextAnforderung = 255; |
| } |
| if(DebugDisplayAnforderung && UebertragungAbgeschlossen) |
| { |
| Menu(); |
| DebugDisplayAnforderung = 0; |
| if(++RemotePollDisplayLine == 4 || NurKanalAnforderung) |
| { |
| SendOutData('4',0,(unsigned char *)&PPM_in,sizeof(PPM_in)); // DisplayZeile übertragen |
| RemotePollDisplayLine = -1; |
| } |
| else SendOutData('0' + RemotePollDisplayLine,0,(unsigned char *)&DisplayBuff[20 * RemotePollDisplayLine],20); // DisplayZeile übertragen |
| } |
| if(GetVersionAnforderung && UebertragungAbgeschlossen) |
| { |
| SendOutData('V',MeineSlaveAdresse,(unsigned char *) &VersionInfo,sizeof(VersionInfo)); |
| GetVersionAnforderung = 0; |
| } |
| } |
| /branches/salvo_gps/Basis_v0067g/tags/v0002/uart.h |
|---|
| 0,0 → 1,106 |
| #ifndef _UART_H |
| #define _UART_H |
| #define MAX_SENDE_BUFF 150 |
| #define MAX_EMPFANGS_BUFF 150 |
| #define DUB_KEY_UP 4 |
| #define DUB_KEY_DOWN 8 |
| #define DUB_KEY_RIGHT 32 |
| #define DUB_KEY_LEFT 16 |
| #define DUB_KEY_FIRE 64 |
| //Salvo 26.10.2007 |
| extern int dataset_cnt; |
| // salvo End |
| void BearbeiteRxDaten(void); |
| extern unsigned char DebugGetAnforderung; |
| extern unsigned volatile char SendeBuffer[MAX_SENDE_BUFF]; |
| extern unsigned volatile char RxdBuffer[MAX_EMPFANGS_BUFF]; |
| extern unsigned volatile char UebertragungAbgeschlossen; |
| extern unsigned volatile char PC_DebugTimeout; |
| extern unsigned volatile char NeueKoordinateEmpfangen; |
| extern unsigned char MeineSlaveAdresse; |
| extern unsigned char PcZugriff; |
| extern unsigned char RemotePollDisplayLine; |
| extern int Debug_Timer; |
| extern void UART_Init (void); |
| extern int uart_putchar (char c); |
| extern void boot_program_page (uint32_t page, uint8_t *buf); |
| extern void DatenUebertragung(void); |
| extern void DecodeNMEA(void); |
| extern void BearbeiteRxDaten(void); |
| extern unsigned char MotorTest[4]; |
| extern unsigned char DubWiseKeys[3]; |
| struct str_DebugOut |
| { |
| unsigned char Digital[2]; |
| unsigned int Analog[32]; // Debugwerte |
| }; |
| extern struct str_DebugOut DebugOut; |
| struct str_Debug |
| { |
| unsigned char Digital[2]; |
| unsigned char RemoteTasten; |
| unsigned int Analog[4]; |
| }; |
| extern struct str_Debug DebugIn; |
| struct str_VersionInfo |
| { |
| unsigned char Hauptversion; |
| unsigned char Nebenversion; |
| unsigned char PCKompatibel; |
| unsigned char Rserved[7]; |
| }; |
| extern struct str_VersionInfo VersionInfo; |
| //Die Baud_Rate der Seriellen Schnittstelle ist 9600 Baud |
| //#define BAUD_RATE 9600 //Baud Rate für die Serielle Schnittstelle |
| //#define BAUD_RATE 14400 //Baud Rate für die Serielle Schnittstelle |
| //#define BAUD_RATE 28800 //Baud Rate für die Serielle Schnittstelle |
| //#define BAUD_RATE 38400 //Baud Rate für die Serielle Schnittstelle |
| #define BAUD_RATE 57600 //Baud Rate für die Serielle Schnittstelle |
| //Anpassen der seriellen Schnittstellen Register wenn ein ATMega128 benutzt wird |
| #if defined (__AVR_ATmega128__) |
| # define USR UCSR0A |
| # define UCR UCSR0B |
| # define UDR UDR0 |
| # define UBRR UBRR0L |
| # define EICR EICRB |
| #endif |
| #if defined (__AVR_ATmega32__) |
| # define USR UCSRA |
| # define UCR UCSRB |
| # define UBRR UBRRL |
| # define EICR EICRB |
| # define INT_VEC_RX SIG_UART_RECV |
| # define INT_VEC_TX SIG_UART_TRANS |
| #endif |
| #if defined (__AVR_ATmega644__) |
| # define USR UCSR0A |
| # define UCR UCSR0B |
| # define UDR UDR0 |
| # define UBRR UBRR0L |
| # define EICR EICR0B |
| # define TXEN TXEN0 |
| # define RXEN RXEN0 |
| # define RXCIE RXCIE0 |
| # define TXCIE TXCIE0 |
| # define U2X U2X0 |
| # define UCSRB UCSR0B |
| # define UDRE UDRE0 |
| # define INT_VEC_RX SIG_USART_RECV |
| # define INT_VEC_TX SIG_USART_TRANS |
| #endif |
| #endif //_UART_H |
| /branches/salvo_gps/Basis_v0067g/tags/v0002 |
|---|
| Property changes: |
| Added: svn:ignore |
| +*.bak |
| +*.aps |
| +*.elf |
| +*.sym |
| +*.map |
| +*.lss |
| +*.eep |
| +*.txt |