From caf833e6acaf3509ddbcf7ff37a3ca97ac7f7d18 Mon Sep 17 00:00:00 2001 From: Thomas Hooge Date: Wed, 18 Mar 2026 13:29:57 +0100 Subject: [PATCH] Integrate many changes from master --- .github/workflows/release.yml | 2 +- Readme.md | 23 + doc/Conversions.odt | Bin 26253 -> 36415 bytes doc/Conversions.pdf | Bin 38386 -> 152289 bytes extra_script.py | 96 +- lib/aisparser/ais_decoder.cpp | 14 +- lib/aisparser/ais_decoder.h | 3 +- lib/api/GwApi.h | 2 + lib/appinfo/GwAppInfo.h | 7 +- lib/channel/GwChannel.cpp | 13 + lib/channel/GwChannel.h | 3 +- lib/channel/GwChannelInterface.h | 3 +- lib/channel/GwChannelList.cpp | 86 +- lib/config/GwConverterConfig.h | 4 +- lib/exampletask/Readme.md | 38 + lib/exampletask/platformio.ini | 1 + lib/exampletask/script.py | 4 + lib/gwwifi/GWWifi.h | 13 +- lib/gwwifi/GwWifi.cpp | 102 +- lib/hardware/GwChannelModes.h | 23 + lib/hardware/GwHardware.h | 8 +- lib/hardware/GwM5Base.h | 13 +- lib/hardware/GwM5Grove.h | 2 +- lib/hardware/GwM5Grove.in | 46 +- lib/iictask/GwBME280.cpp | 2 + lib/iictask/GwBMP280.cpp | 2 + lib/iictask/GwIicSensors.h | 13 +- lib/iictask/GwIicTask.cpp | 7 +- lib/iictask/GwQMP6988.cpp | 7 +- lib/iictask/GwSHT3X.cpp | 138 --- lib/iictask/GwSHTXX.cpp | 254 +++++ lib/iictask/{GwSHT3X.h => GwSHTXX.h} | 17 +- lib/iictask/SHT3X.cpp | 4 +- lib/iictask/SHT4X.cpp | 131 +++ lib/iictask/SHT4X.h | 76 ++ lib/iictask/config.json | 148 ++- lib/iictask/platformio.ini | 11 + lib/nmea0183ton2k/NMEA0183AIStoNMEA2000.h | 76 +- lib/nmea0183ton2k/NMEA0183DataToN2K.cpp | 2 +- lib/nmea2kto0183/N2kDataToNMEA0183.cpp | 328 ++---- lib/nmea2ktoais/NMEA0183AISMessages.cpp | 201 ++-- lib/nmea2ktoais/NMEA0183AISMessages.h | 37 +- lib/nmea2ktoais/NMEA0183AISMsg.cpp | 246 ++-- lib/nmea2ktoais/NMEA0183AISMsg.h | 39 +- lib/nmea2ktoais/README.md | 56 +- lib/nmea2ktwai/Nmea2kTwai.cpp | 2 - lib/obp60task/BoatDataCalibration.cpp | 190 ---- lib/obp60task/BoatDataCalibration.h | 33 - lib/obp60task/ImageDecoder.cpp | 23 + lib/obp60task/ImageDecoder.h | 10 + lib/obp60task/LedSpiTask.cpp | 2 + lib/obp60task/NetworkClient.cpp | 593 ++++++++++ lib/obp60task/NetworkClient.h | 42 + lib/obp60task/OBP60Extensions.cpp | 168 ++- lib/obp60task/OBP60Extensions.h | 8 +- lib/obp60task/OBP60Formatter.cpp | 139 ++- lib/obp60task/OBP60Formatter.h | 10 +- lib/obp60task/OBP60Hardware.h | 14 +- lib/obp60task/OBPDataOperations.cpp | 563 ++++++--- lib/obp60task/OBPDataOperations.h | 141 ++- lib/obp60task/OBPRingBuffer.h | 82 +- lib/obp60task/OBPRingBuffer.tpp | 159 ++- lib/obp60task/OBPSensorTask.cpp | 37 +- lib/obp60task/OBPcharts.cpp | 808 +++++++++++++ lib/obp60task/OBPcharts.h | 116 ++ lib/obp60task/PageDigitalOut.cpp | 153 +++ lib/obp60task/PageFourValues2.cpp | 13 - lib/obp60task/PageNavigation.cpp | 607 ++++++++++ lib/obp60task/PageSystem.cpp | 88 +- lib/obp60task/PageWindPlot.cpp | 546 +++------ lib/obp60task/PageWindRose.cpp | 13 +- lib/obp60task/Pagedata.h | 6 +- lib/obp60task/config_obp40.json | 1001 ++++++++++------- .../{config.json => config_obp60.json} | 832 ++++++++------ lib/obp60task/extra_task.py | 40 +- lib/obp60task/fonts/IBM8x8px.h | 202 ++++ lib/obp60task/gen_set.py | 65 +- lib/obp60task/images/foxtrot.xbm | 67 ++ lib/obp60task/obp60task.cpp | 59 +- lib/obp60task/platformio.ini | 13 +- lib/obp60task/puff.c | 840 ++++++++++++++ lib/obp60task/puff.h | 35 + lib/obp60task/run_install_tools | 2 +- lib/sensors/GwSensor.cpp | 4 +- lib/sensors/GwSensor.h | 5 +- lib/serial/GwSerial.cpp | 14 +- lib/serial/GwSerial.h | 5 +- lib/socketserver/GwUdpReader.cpp | 3 +- lib/spitask/GWDMS22B.cpp | 2 +- lib/spitask/GWDMS22B.h | 4 +- lib/spitask/GwSpiSensor.h | 2 +- lib/spitask/GwSpiTask.cpp | 4 +- lib/spitask/GwSpiTask.h | 4 +- lib/statistics/GwStatistics.h | 12 +- lib/usercode/GwUserCode.cpp | 4 + lib/xdrmappings/GwXDRMappings.cpp | 5 +- lib/xdrmappings/GwXDRMappings.h | 4 +- platformio.ini | 17 +- post.py | 8 +- src/main.cpp | 16 +- tools/gen3byte.py | 32 + tools/getPgnType.py | 29 + tools/sendDelay.py | 19 + tools/sendN2K.py | 793 +++++++++++++ webinstall/build.yaml | 194 +++- webinstall/cibuild.js | 49 +- .../config/m5stack-atom-gps_v2-canunit.json | 1 + 107 files changed, 8565 insertions(+), 2688 deletions(-) create mode 100644 lib/exampletask/script.py create mode 100644 lib/hardware/GwChannelModes.h delete mode 100644 lib/iictask/GwSHT3X.cpp create mode 100644 lib/iictask/GwSHTXX.cpp rename lib/iictask/{GwSHT3X.h => GwSHTXX.h} (50%) create mode 100644 lib/iictask/SHT4X.cpp create mode 100644 lib/iictask/SHT4X.h delete mode 100644 lib/obp60task/BoatDataCalibration.cpp delete mode 100644 lib/obp60task/BoatDataCalibration.h create mode 100644 lib/obp60task/ImageDecoder.cpp create mode 100644 lib/obp60task/ImageDecoder.h create mode 100644 lib/obp60task/NetworkClient.cpp create mode 100644 lib/obp60task/NetworkClient.h create mode 100644 lib/obp60task/OBPcharts.cpp create mode 100644 lib/obp60task/OBPcharts.h create mode 100644 lib/obp60task/PageDigitalOut.cpp create mode 100644 lib/obp60task/PageNavigation.cpp rename lib/obp60task/{config.json => config_obp60.json} (87%) create mode 100644 lib/obp60task/fonts/IBM8x8px.h create mode 100644 lib/obp60task/images/foxtrot.xbm create mode 100644 lib/obp60task/puff.c create mode 100644 lib/obp60task/puff.h create mode 100755 tools/gen3byte.py create mode 100755 tools/getPgnType.py create mode 100755 tools/sendDelay.py create mode 100755 tools/sendN2K.py create mode 100644 webinstall/config/m5stack-atom-gps_v2-canunit.json diff --git a/.github/workflows/release.yml b/.github/workflows/release.yml index 2aeae17..ea089d5 100644 --- a/.github/workflows/release.yml +++ b/.github/workflows/release.yml @@ -62,5 +62,5 @@ jobs: with: repo_token: ${{ secrets.GITHUB_TOKEN }} tag: ${{ steps.version.outputs.version}} - file: ./.pio/build/*/*-{all,update}.bin + file: ./.pio/build/*/*${{ steps.version.outputs.version }}*-{all,update}.bin file_glob: true diff --git a/Readme.md b/Readme.md index a9a305f..5d2a20d 100644 --- a/Readme.md +++ b/Readme.md @@ -43,6 +43,10 @@ What is included For the details of the mapped PGNs and NMEA sentences refer to [Conversions](doc/Conversions.pdf). +License +------- +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 2 of the License](LICENSE), or (at your option) any later version. + Hardware -------- The software is prepared to run on different kinds of ESP32 based modules and accessoirs. For some of them prebuild binaries are available that only need to be flashed, others would require to add some definitions of the used PINs and features and to build the binary. @@ -170,6 +174,25 @@ For details refer to the [example description](lib/exampletask/Readme.md). Changelog --------- +[20251126](../../releases/tag/20251126) +* fix a bug in the Actisense reader that could lead to an endless loop (making the device completely non responsive) +* upgrade to 4.24.1 of the NMEA2000 library (2025/11/01) - refer to the [changes](https://github.com/ttlappalainen/NMEA2000/blob/master/Documents/src/changes.md) - Especially UTF8 support +********* +[20251007](../../releases/tag/20251007) +********* +* add AIS Aton translations (PGN 129041 <-> Ais class 21) +* improved mapping of AIS transducer information (NMEA2000) to AIS channel and Talker on NMEA0183 +* use a forked version of the NMEA2000 library (as an intermediate workaround) +* [#114](../../issues/114) correctly translate AIS type 1/3 from PGN 129038 +* add support for a generic S3 build in the build UI +* [#117](../../issues/117) add support for a transmit enable pin for RS 485 conections (also in the build UI) +* [#116](../../issues/116) SDA and SCL are swapped in the build UI +* [#112](../../issues/112) clearify licenses +* [#110](../../issues/110) / [#115](../../pull/115) support for the M5 GPS unit v1.1 +* [#102](../../issues/102) optimize Wifi reconnect handling +* [#111](../../pull/111) allow for a custom python build script +* [#113](../../issues/113) support for M5 stack Env4 + [20250305](../../releases/tag/20250305) ********* * better handling for reconnect to a raspberry pi after reset [#102](../../issues/102) diff --git a/doc/Conversions.odt b/doc/Conversions.odt index a44672b0fb4ff6cb0e502ef7d9ca216e493636a9..1a181ac6c931a1ce8d8631ca872315ef45c5bae9 100644 GIT binary patch delta 35065 zcmZ^Kb95lhw{4tBGO=w;GO=yjwylZLvF&7H+nCt4HL-2$ec%1v`__AJt=IKOpLOb- z>Z{*Dj-CYV&IChHkOqf90|EI40_k1uf;^naX0@m?tZ<7fHrK%zuK(EoPgfwBFkmPUvic#i8D zt>6Es-LSbN7F}Esi_|?>Rl6gpjv);DmnJj|PLr zgXI0*>%?=IkF_7h_FJ~J6eFX)kJ$wcjHCxK*T;6&rB4zvgV4Rzw3OnZSp>4Wg=DoJ zHr2IB8?#fDZH^RsZ&1Z9+{FWq%xOAfX~&$X{LAOlu%)63B$>)3 z11#obHias{OJI{Ih>JDoIuHs(7lIo01FzW*ci$+)nOv!eQ;2J#KCX>}IpfJh(AOVr zpqA~ZJ1K^XAlm=tFCIw(X0!1V^(Vwo-j1ZG{%6C+HmKBbXT4?hWEj*56&7RaC%+z5 zPj7FfqK-ZAopc!KaLjqmDcg4quSSE&#J%g4(VqX(DD{?1cxCsEtt9q?xZKm$3Mi+O zFC7$}2Lv&okEi!$)$^cnPf)($Hpl6ynLsGxGDhD(u^RrQI`vBe6w)=CT>d=#3YlMJ zQNKfU4V}O`kHMC5h}#WXBHXm*&Dcr*q#fLxsvkM0p*GYGc&?iXn3>;rpDs0e z(C6ad<;cmBrM>ATNUcRE)q99vc)-plA@PSl0(H!LNF|2)|(M<>r1A4HP>8dd@H;k#Ok_3^T4P9KE zqpJ^@TWJN%l-3mN_GD88YRzoCg37?uV3G^S;r8wOm5!(Y(_xUts=99kSBK-GXjP<2 z2y^m2ZGNwKJ&q92F2N`(=>eIJw^^gFd9$;NSg(TBwAejDKYsJrBXYA;uvPGwNs9C; zeIptJue0`+F)R`%xfLM9WfHNbgrFIScN$BVMw8qH|Aizo7HTOOksd;#bua>}Kz+#} z=1>pLp8&xIsOfGQ&im&YsK%kxD*iaqNVw}07(*L>rMtqr)T+u>ljT;WEts$I08cG{ z!uVCnsF9ykt==cA0OQ-EW=b&#hmCwSb$^d88zwATGwPNr?nu6XC3^7b_s9?=%^KIU zNyRboHoiP$r_lq2_Saai9MYPViwS%MPLWdsRVx<_u=AgFa->aWV2UD0dF5?ED~Kca zexJjnMdU)`M_3+@xreHdor&L6aGp!vit~MCviI>)Qz~9ar@%Ta@Q2Sfz%y#8ygIC_ zCV}Y7dr8hI$4edS2Nku1{Zx!72NRYQ%xIF8i8)oE*v+L(f`pX;5d#HcO{YCZ+E*L? ztPLy!U5zz83${kxMLmR!kbj8=n!mY{Chmd7GsU%h!_EGHu+yoQJJjZW>p)bPYnIxBcW!ELAxo5{W%l;a8>SO_tX^wAp#PxN_RS@mj$weJst2-t*d9t1ohnwttqeRN(7%V7nXcm3)$LpMo#l& z{5QJtkN5ZICdj+Vl_2Vo_R3yL5V$xg-tZFWBdWJ#+2<)aKy>RrHl2Dbt ze(LO*2cI3xa;-8D#@aD1hRrr>6F#0(2TsL6zp(^Gn6%SZs9E@E-MVH=#abSXhQVOPJp129PH6 zLGc8y8Ob+>rjSDgJ>D5K*_O6NS(9^-U`fMHDckyJ;XVt+7)hsTe?-K6!e9kV|2-#K zD5vs`!wftgeA}R*^*sZ;G(8t06j-FMg+91nKttB4^zJuu$b0dRq5oI94 zJHQ(x6$y}N5DOZwq}UFExReADkYeO;{K+p&2Db@ZzWSh zU9<}rQCJPSctUOjXUdF!EP5y7VX=iaI#dh9E=a<6#5tFHB>*LGl3@i(aTR?@xqHSmqA-iNe0u`7%#X}asGH=`CAmzuUTmhFd5vCf9ayF|I1u`gZxuHzcg zdW&xIWmX&3!0oPM`zM4zDwVWk?%*r2bxN`tUYf!I-YuMo^eymZX%Pv`S$YZ!_4X-l zkYrwYj=qEdiFafe-VB&wT8b{3n1@Og*RS4Rhvv-jA)sF7))m$%=7Suq4RH0ej8_XJ zX53`U@O3Ws1pAG9w99Woz$|SI6~Sz1Q7H4rvx;t-EU$Ad0&mFX{ggZ1m)RR?X1V9} z`&0Ni$E6?o`FBY6^S8q_Gx|j7hZ@!VX)#mr+~L$Rz}Qh?MPLj#ONNFg(`I-qjHn zd?2Tdx@ZRyN-u!9z?rCb!B(o4&>Q(L$A)nBO(BCqfjnf;J&`U0cJg?~US#Au-vJPD4$k^Y+Rx+FUH#Xtj&>r_>!%L3=Iyns0S9hM>= zLOTs>9nHNnKP|eH@%2*OG9S`!)_&WH-(efqDxn3a5<6!FW!hKSs}y7fP5^|a8Sa?P z(0h(h)IddQyPBR4Bm9_yNL`1Rc<-_z-=J#r%-&CtPrKWr##0|vCcwH-t3SGEqgT&( z#WMGl!b{pUw{Z&}zVl%KNk;y)V~ivEbQV*;dMA_1Bqz5e%c05a2pJH!;&?B~Cj5j` zkcR&D5aG^21`7g0%>@GTAO8C7+qeJXuMKKo+@SwqmTS`Zz=qRab3)fviNJ|U5ry_# z82_uh*pKy$I`iRr)fA)YQCV0N;&k*+{J6%dcIPI<+IIW8*jl$E#apstMwQk=G8G3Ob-jFp zu~zOphWR87gArqL3r5N9&rAn<<#A~lwk<Ojg}P?FS*ZV1?`Uqpqqj{u?(CgZe)rz6Hl*y5{rg?*!v7$+{nkg2FRhXD!YJ~J* z7u8geNk!FLYRagk5HBc(PE9kLI4;FN+mwk9crR5XX;8QXbiNPLTS>mB$jBy^VJW8v z^nt7VUP`I9=bt1Qf3$2avX&)ajQ(jV_pUWjiDG!`S%v!No@5WU=B5G_T3mL*BG8i6 zIhNpX{70NHgLMDmaF7@j(#lA*9h+)+u}FWg=In)wLhXW{tM8bfHc@ID9AQrbm#fPQ zUZSLm>(Bz<_0`sX?KZjGVkpvpJ)YZ-BJh%+xYE(3(!iqsQw11Km2ItKP{uD zyflSs>do$xu^DrXatSZY7n}7JHOiSm6CZ=h#@;+wxvb+3SWxVv7{Htt7U~?4oDU05 za|t~9pt1!sE+(pwUnd49^rC)$$&F3`wxP$N3!g*3WMaU7-4JfgTpQ82odtzEs&7EK ze(}2EBh?kiQS;=O(r*L$i>3qhXsHJ;=Uyom@e%y0KaVqmxTx!VcFk1{`Ly>kui`5sw@5N0;jpQ}M%CQ?wUN7x|WSH4T7r7nPxaqRhy4qd%-k{ikzX@2twX2O% z@JxhQF~XNp3!cgEjPl%WnD=fXbXD_M0kbqHm@Zct8lH=lUwCW|9*K0#GcijjFpTaL zrWz_|^oi)QVparVuIDN4?bvgG!th-D!VU7T%wJ?Kcy^pPH=48yH%b<(YQuBws>4co zF{!k~_LeYKd^M~P9jhwTZC2Nau_lVdnidT3Sn097V)S(kgUk_C!-LT7y~TYm!h_PR zziRUg$}8Q26n*154_L&_({&-CRvD}?A?k>iMp&RCacz?rBCVsy$2&Rz#5+9vZt1=& z%+1%pELU19&C1}Q5{)FIg?wKoBH7>!JPI&5)U21GvNZc}+n>P&FBBi1> z?~QU4U@{K0G7y;*Tz40pA|M@1Fj2Cm*{+ZxJ1Ud0xJ_EzL0+*GP*1~bjWkn3BBh~@ z)0RdK023|`0Zjx}U#B>L8u->3bq)1IBd5n*Xe@P2n9P`-kyKl0?(ebLXw{L^yV=k} zSOn#TeHJJ)q*(6A)PNuCRYbfffp_^-zb?L~XSrzH^ig)+MAmp_6xMtFPxIY5y?nXg zcttpKWtGhfIPB|&q)`8M!b|faFvuavDs#*m+}xIY;^NW52yn=WdWq@rX=gzPDgN59h6b$tT4s#~<`~Zd=c$xi(Hgs1jYKU>_76 z%9DY$xH8UhHDA`tSRNWx=#zovoZz*(AJ{gaSROz0*JVPpeG=x=7*y2%tN;DKxakmd>iv*cQLS>IoQ^8qSiExwyTP93U_&w=CgP`$1aq^ zq2rU9l{lRvk;{f;B1s=7$xD=P(t>tZb(|t-=F|4VXAhYa|DwQPC$hhel9c)~yKjE= z97?7jR^kn`gtoGktsJ6B4Kge3jLWbwi0UfAo=fF%X$R+f61|miI{G^S5v;$5>FQ!r ziY94b>lV`$XJvzb@`1N>F#LY+Cm*8T2JVW6lk(S6LXObqT{u8kZbev1eMaBTn-0`v zoo$ELd2U@{7@2Ts*(mW+;1Un=((gMy9H5WxM6+5K&c@eqzhiyq^<(;8jiHttuI+gGFnje^6_#tdN1juP0+nfQhnGw0_ys zC@mJYR8S4Q3^eB%uSsN)7%{|AOR&xiuoR!#RQ1`L(t#%G6V+S+o!o`OUqNf@VF^F- zMi^(^f*(Ip30=tJ@DaNXfe(T6r*?t+*)|^NdOBX+Bp^397D_czro$ONK>ncG>s=hcD&Yn}>GC+{kS*4GSOFoq=gx0bl!s1^4w(g)gTi@p^jsh4GLQ zcTWgp@sONaD0<)T_Ypi5kL$U={xpPFaB~a)-6X!C43?HUEV3)0izGSSOBd|%7kILf zCfa&=*+G~Vyz|FFu!o?p0R1DOLXJ>;x3S2txKZvw*OBTC?4%29fSkuuv98&|z`qQs zuqe4CFzH|^cRx&x9pAokfmeQq0p;&!o87*J3RlvOOJu@(%eMlNx_q-6u24PA2w@YS ziLrkJR>e$|6HFBXq1qt%oo$TDb8+VtiMjRhAMK~-m#n}Yg8ZW!TalEN?X)AOFyb;s z2^DxCe?RE7L3W5M)(|RJa7~V%r9A zt+}PhRuGe_m`fc|Viwz0aImWob4zE?Dke`h&VGP`avw62!*3z(N?sIs;gX#~8sx^1)fZ&`&-@%6NmGB|rtm}_NBkzds~X;ZT^y)o7W z+`eiKbv-IS87}6yUGieOEa=?jmVbtkxuBDFd-V@$5&isSu`2YEF<%Zx`zr>Y!3vHx zxj7fE<0JTHDdE(XrSY5M*fFSB@B$oxv15=Fu!aH+{qcE9Y)hA$KD7eY7IS1F6KCy( z?CJIq$<#)uTg*F456hX6Y9Se2jMzX>mpR;M3is_SE7suJf$!&4c3>j*L5ovuHQlf$dcogh#tN1ST`A6Ops^|7&W(xR*LaTM_P>R~|8n#S z_w8wWK*ibAGed|P&Rs;m zS~@FM5?zSE!BKbR7Tc22W4tjJnPKc2bjR|QOp0bCHVDP!cWd}@we`xMem5VbX*=sa z$|6cgqK8-n|0bnvQ|8IJ!9DLH@n8r-N5h@lccu({-T^b<+1eD(bz!q>7E-eK0B5X~ z0j;feb47pEd)3Rg`R&Rt4|j|x<`IZ2_^J5GW^!EAgaztN{q>$^Q5Lcoe)idd(}mHc zbCJ%4PGFfP&qF{__wk6pvn6l=a~hN}HGQRc-#)Hl8KQ7)GsQsabEll8&Sle$$;^ay zWQTPiX40mwQ!0BNgCTU)XH5qUxI>6%AcGSs@c(lakd_1TIUYAdIa1lNQm3xl#%B7f zY7K$QndpqMV=O?d-D??q>U>=Qs`l_V$les=TdngA?vOBusDumnbQgPb+DI(k{x2LV zzVA%6PMQLam}tM7E);^q73>WSe!((e7|1|G)z1hZQg1WBq1yYUeG1n^0k4QproXM*Zf7ZM0n&6XZT@h7M<-w=@z={BSwc#mSU|DH((SWltmBNK|A-I4q z#p6wKBP8k#T8ecPnQ!-FV9`zz{`S>IeDHn4$ZVE26w+6U?>&$fk!fQCnMnDVK~()) z0QX$6SvtNjo98yA^^(ZW0YENJlsXf3jFGqEXnD#!e+9iMG-Te2`^>C z4Nlz(vRBrVMskWHNSPbO*Ud4Y(1WvKXq-X{QD3JA+TYPvyJ zu}f=5{50Bq*S%62f3Kv9%(2gFs1g2^XSgnAULlK{&OtaB*>;jT>vP3stF|&kWKsH7 zL0|D(dw?n7c}?t;vZCQeOAn(L`*aO-Aq%rK(w~d08MbzC{e-v!Y<*6VMgbGr<;1>! zGLW+>9M9Uk+^9kO4*+)aNjQafcQ_1Yja*9+4!P7C50dU+S5+F_Zbr;=QPVB$K7<1Uy&_-J8Z3}PMO)T=7J8Sv&@u)|(ps#WxcY5Fv> zP@t*BfV8eT;`w~&#_R_^w)(Q`a|eWKI%l20W$+!i*+RaZ7}N1Xq4!Y2LOwr2Y-@WZfhXP?_FWzV>Eddcv3vK5)Jh+tRf^^Ix^OP^6~ z_%5-9$Wj2_y-NXtC%FfVZ~_QqZ>b8+hloPgl#9JQ=cKxTHX#>IG#E%c^$&@gx>9>wy=(6ZYC;>|Qw{$i z99lHI;eG43Ct~e|L4>Q@12gS25&8&u9%@=+8hR^i_d$XRl%UrrK^qFP-*V(Tlj(nw z|MFel(UAHyX#nG+^pj^gav}%GDag`M>p4EYZ9gSOY*Xy8*bWk1v62Aswk>#pMyWl3OT+xfEmo`cgl4f65 z74)#;UPX}9et6zLwWPkFf)6tP{)lMqSa1p87O5-v-TWX?$|ac6t;{**FaEQ@d?+g+ zTG5K}0J#u+bM&4jB7BHzX=DdP`E6<2xur~Q=;qHpUKVzSE$ zB(HuIXRE7AeaJ2_SdOPWpFu=h;qA?E=H_bE@H!3S0u}x1Mlz_$)2gpGxnOScOh252oDA8-H4@ z+(sY@xBIX8zh1U#Vt(puKJS<4@dx~LKvu!Xm^*Sp9%?J9&wYK>fUMDE?HE^wXF$ej zf9%c7H~*rh;a>S}`9xiojA(oDP;Nr^%G;=Z^EMIcyiUy3UBc!xY$^4C5w&g(1vnGT zd>A<~c@9U`L*Zu+uXXN}wOD2lcw}$qBp;j=t5g(lt1C)i^l8oy%0Z`3$TGnPP}w8j z8+zDP#YLuB{%E!KLm)h}ZI=(x?-)ktO+2!S zIKO1$mM$epbM8TZ4ku0RGRJ}+03KoNZ+I1cN#cil{5j-#oXvZIQ2zWi_o2#$MBY^B zxgMyrnggjdsUgOY?5#H*34c z)?jUoirOx<*;K_YkLoI^3*|$EThhkKoue?F$J9L)#bm!E82t)9Z_Nyc40u9Dk@Q<6 z1xvPF;yQ;0+l}qXkhEtYZ}6KKU;ple{A@HwdpSsN4^G7YN$#R*2j(2geMuREC9$(% zbpF$hh3@d_)|S27+(eJN-Q2&h3+DEDu?Q)FSM;NEQwftkcp9O+TdRA(l^{Sb3MeJm*X?kziHy%Im)B%_=BHgeA z*qg4sV_s`KLg+mPIY09-(%3jE6seopKJBFEoqBmij^IM`68!LO1~7bYw!>FILg#DI z-4dcdxNRg$=oYY3wp$J^meI(+S`NR)-o2_8AA!VH(z7^(*_9)b(e2+e*#yPkyt`JP z7Ux$~4l5}CQ8I1j)l7GzXWG6H|J7g1MdE+cpo4&%qJaKC`YXu)aeMLuFN9#2p zMVr?tFaGX(*%hSepzlLl9b-^b2P#kzP+9IgFDsYNFG*3{fH|N&hD(*Ro%EVgtFU9ZFd4u` zs`?Y==|=*=^YmBh;YiJ#YTB70%d>pRlU%PY?d}x|V&W~C_u`YikE#8~Kz$dEJD!Sf zTWX~$Be|K_!V;qpJFlW)m}1!9)Jvqopcz}dJcvFtQzZ25ko@f^&l5HgfFVdO;v_`@ zMI7S5vP1T+10QhGgrTr;higqn`At{!&Dj&<*Zu!1TTt z)y~423gWH7z|#-D96*r%wt0ef%DOH=Nc$ zK|nUZ|6ln%u@({!7}Q>O!r?^n*{YGaxddT!G@`!2*p7=c5C)C0zN0Y1nb9JZmBcar z^lfJq=+MFIn`xKt(P=AE)0ZO*M+ErDPZvowD5F0$%DbwQ^!#IFem>kApV%$%dFj92 zoyH=XF~uV<7^9lPSOAATUfu(pealT1;$re-U2&Sa?0u4e`Z5Wq`jg^DVXk`3Vh+D9 z;@B;XywquEY*G4?Wv5Q|^ij>xQB8DKN=0gF>VbpXLn))#2hr%1I0k{Qa@oSz%hkjD z&T<~O_7u~1o0pGt%PDDf8t%$s;K7hH^?gsqQ(}azCM8vJbr=Pq^^?l5t69r(+3U;q zh?{S#mPibspsl)m7L9OAnw_6heXxDdJ-8M2(4N|z{lTcG`rj$8mN_j z6`^vgeQppbG*=qFhPY|2bM?}6hvwa+Ltyrx+{6OP@6;0NM)S7tx|6(ou4E5xeLyi+ zap^ISj+*X_54bqh99|t@j66tq!U)dc(P0Okf=$??pD0#&Z{3pb#^Sqf`qNB;>e)K& z%qr=V(%Os+nYNgyrSHug=!?`NrR;I;9O{oZo29iyHdlC!YX~fV$KVD8j0pd2cK0_t z-U0#U{IBO2M(mEi9U+w(X^dJD zi1ax!C>7=EA^eVdD#MCX6R!G@$9Q94&vZb(*wYNrl>UsU_-AkTE}-G+u|DL&7esJ= zhk>R$PSc6~gWJ6#R(0~J%JD~rC&MX|2DdsuTs(s|+rN+@bH#ddlZ~3Bqs@qTcZj@& zA>XoIW(4zn3>p?2M9`XJXdEG7Yi8|v8;YCBsm=*yABcDSo^gw?{GE@yOh2ysTz5Dh zhfh0x%4A@hvgMFXdPsmkaHh=`jpC3(T>R8O;DPUOVnl@0GV1?RIg z*_7TFlGb2JD*5!&LA zJU$OD<=w>gC9%;$iYU+*+}(|rsyaF`pCj5v^M0$qZV8Gpus5X2C5!0}d|*PMM$^?c8FeU zoq$TQqO$EYAfD80;Dxx8kuwL(G4M!W#!!b(-ZMDqDT#%-g`)bgVS(-Rt)5YLzc^p@ zP=%_+P1P*|NrunJ-v)wLQsE1NRA#gar{prawL(v#u+6rzOb|JBjU-`3Fa7^EphTz~&~8G~QqYYOTdp`midmgB`IT>ROlyO8LVKtd0INP_IU z24;28Ga**Keo&sTm{Io~Hk$Q$o?=|hX*_q*?%XV$nr8obq2md7jr`_0tXXx1cds&0 zW_V&GeT9?0ZLQ*q^_LT{v2dV6NICi?3Jo!r=n$ff3jN(A5{q33Y=jdA!ogbLh^vhT zAD15AH9385s;QN=i(Dy3GdHD*{d4_+<;UL2G&2c-Us$x-&k2?YJ!WOu+$_l*9!&jk z^m{K~wXzcJF%E>lrX(5Vus5ds2g4uJebX6f`9Ee^lQOOP!0>bd)`+2RIG%~sVPW&u zy=YQC=qu*o{xnq1YY!FJ4aC^B!MXcP>-@}v#Ms>8xbS zf_3p0kT{>|D#^M5_!2z(-~D{4hMpQJ3WT_XxEe$%1~8akl=ve3h`a$NF$Kx720p0V z+*4J#*U=u{hYX*0QxT~9ox9!wqj;h-b%QY^o~8HO3N0%7(6OGQ=#ZAO`;>b$*7 z6k(r6ciOys8ApFgs~+|PCz_8j(ZbM zDxowe`UFAcm+YTh*cG2)#PBsQ?L2EnOx@>58U?uwU0J#o`9nu1^Z4GLqf>kHbzQ|{ zi*T&^6ZBsqU`O0JvkVOalEC&qMBtzAND=>QBfd?D=vT8A2uQP5A}PEe01l!cqayk* zIRt}+gn@?x1NjaE1qTNQ28#iUf`<+RhJ^%!fq@B!Me!Y<5e=UbhnNP7f}H{bh71pl z3>TZ40F8+dg_w|xngs73FF83S#ZMM$CT><5axTUn92}hZ^nwJ;62$ZZRO}Mu+{(<{ zVm}2`XoNM{1*JK~R5<`yBVHwIUR4Jn8Z2=JJaJZXK^{&;UMfjJ9yP(A>f-E1Qmm$m zJPvAnk`j^f-9=qS`L%I>s_ao;pUBTIMch>XODf>P}iB zMtVjzhO(AM+AfB&F6LV1W)^1F&bAJ=HclSDY|I?&96X(@-CO}zd2@d?n?N1s2tD^W z6I(wkw-5`T1Q+jMTfZ3VfOOA*2#=6t_viwj_#&Uwx9JF^fs%OG#pByZC= zU&m-a`|tp-usAimFf*k-D&Rl;)K2H@USDO} zU|nW!OZ5{IRy8@%D;=j;5K;vMHdaX0)$uuD5D_pka2fZE3W5 zVYFjqsBV3%X>GiHbEbQDs&#*^b9i`oaAJOXW_oOHbzx#~X=Zp~cH-~cz}o!y-<7Gw z#l`uh)#a6?g_ZTyrTM?B3+wCaJyY8wD+d!B*YoRpvzzDZn>(|cHyhg<(>qt=+qX;G zM+@6$8#}=M`rhg0@zu)F{pQW*!Scx7`uxu3`pM?p^~T86&h+8-(%#O-`Of^=-umV7 z=FRT({n5(T&F1dz?#|)q;ql@A$@$6Q?)k~V+1c6t+3nut^XcWy<@MF!_0#_C$KmtW z#r56U{oDD==iT|<&Bf{SBGar-Q&ys+XwLSc=!DD{PBAK`T1F}h(8PhLIffy zBBrbdvFGjC$Dk33% zdMtoR$Y{#P90H5GIev0wXsQE8^6u_*ae{d|^C|P`2oGE01cN*s!XKguqA7{2l)SWv zOpx~9LJngEWA#H)LHge!8K4!QC55u^Z&6CfP03A3_&4GIpYmS`|E2){JLA7|{<+8% zL@6r1U`Da9MQ|P^Xud_@&Xafm<2|RGJZMm$Ge{sW!-%;=ZvP%jj+j3`85)Y=q2HdH zgTE`xX+@F#*z>(8$GhZe=;dtB-TRWcd=EwXdH-A9x!$Tz(>1FmW6yF|SXVb<0`!aYCStjSR&aGXf zg{}BSNw9q!g>E8m;K5k$^UOmN(*e;36r~PGk@v<#%GCeD;(0BS_l*sGot^f*{b!eU zm@gvtQu_0`V(b0H=ZJW0VD+tgbmMI!$6J9js~qH|0GdDmWp^fL#3c4S5J)Ps)vPB3 zc@I1X?(_Tk@SmL-!Cw?D{u)ude6RW-+aEELi2fliMQwKKhAO2Yb8a#wN(O< zonONB-DxSgT^I|vl~A2IHM7^DCf#pk=lzJ@r>z|2NM)gXh!Q6DqJKYNy^Z$R{~3+< z=iRjTnFoOttDXs-=+jQP%&Iy_2w`UpLJ0q@>wv#e)b6 zbicRKJ?A_PehDu5#e6*I_f7wElYs7^n$JaS6?j+$IIy6%)4-Fn&-X6A%h_0YkPhc7 zx4ftt8uHSbgqRV&I~A>rcf{DSxjFvZS-7vT+z>3h_NQK!)s|ON#IY~44VHimFP)HF zv2hE?U})x?TNiqtCSS;G9vu-!CgqTkTKU9Z*U%f<8?PIqBJtDnQ0Nn08Wj z@u`3Dy-Dj$u5veG}by#rvK+tsJ>254|r@)D~Cw?@8Sn^o5`_}^8sB>90U z>v_Ki#NVeqtJJ9mX!3p*_^k>vAm~t36~P&F3M9C-`R;#E#`GXKQZZ8<{%IoCngjQ? zeUr2}uM%N~atXR0!@VhTYd_2mMyxKkdc-B#x>G}72e|H^T62E$n>^(%D1}9GT+xJm zA?FKUG!ndM-tA<5jQ>X;a$KaNfCUc%dLj}#8O|K0Q2vMpC@MW(@{}GW=!Z+=L>NWV zWCrCA`~wL8_b~qh3I73vITt~ExS*h`)(Z14)O|=(V%8*^4CWOkGEbQ*G84eAJCN)XDQt{A)O7OD->r*nGlkR6DMKo>UHx zVPW0Jc*L)pBlUCZ^wHC{xyxk}To8h_HTt(m4z#hZ@l9YF9PzIk$Tsf#eLCqA|Fw9N z!u2rWD*@iyekdQ{i<12^6WV;+9WilZJljRLj##tdyu;1JT#GpRnw`pf-9z|A&foZ8 zd^D^1aTChcGn4qwM0<*cCU|!8t~viiY`=6UjUCPY5dJF331(+rRu$^*tJ4GLX6-S% zG{2j7?cdQ!44E%JkgFY|b7$r4M96Tmp7C8uN|}X+an}S~x1_JPTK>V29q{Wv=k0$x z2m5-uKIMHcr9sxazUzMhpURJO)22Sa6QujGS9h|@Mdy)jSZ_1*V&^}g!}FdQ`bxiZ zMA&-d_T|0>nK$XWZqBC(d$sXZ&`=-9KmL(;)sI^baM3v1uEQewK<>J+Ebw<-@oe#I z09Qjon!ts~OJx*zy_I`71-^c=@~f2LmxBEI=6yyYqE`kLkS^zrbt zebv?R)b(s{3hmLW^tsZ1TQ^$AS@TX2~38U|HUSWjZXKU`q5qcPL8U4~!?P7$BHcZ0kCp{a*B>F9l@8g97 zI{Il4crD5KoVCBa`&tEW0-j{`{BlFzS2_{-yswV-`g1msLiNYwzK`Q{J<>j}cfTHa z(Y-4jPJ33mTFjU58T-}vV1Az0LDPGGw0jY{2fdD5Wq(~mezt7I^S=LBg{wRV$S+AH zuz2rzSG=YzA4#<Gz06y z#c^T0&-m%o`ibtxjyGGQE_mo|8$HQM0qkUcfT&)Js9~4r~h@xUEfWZ@=*gM z9T>fw_QqN$6un|zH%;?@?99`)z47aNNHo6;GaYUDqP0K$c58zQu;OS%%_T?WUHQ0G z&aDj2D~Zo%NX#+w(;q1@6i825A2uTh6+Stk<48g_XZ|RinmANVC|CvNw2ku zFjhKQ)D8l#@mWjrt)yykvVxg8DxN6=lAp%Yg>Ay?9ow@jf9 zK-n6uuG?6WHb})|XOUlCp4h6a{UU~$mTG?6$%&h@704>fOH#;K{qS9kMoefLd5U#T z{T1UJ*`D}^EWzu~!8dY%&a4BiZDp?7-HEq3iPUv;Yf6`EH8AiQY!6b|Qf_40eu%@6 zl>+=C89Vf*Wv2-Q}H)zq>VsWn(K`LvMNn#KW(&hn{a3ax-rHaV&)ZgYaM%oHTVc&!YUnd1AjuEUE0DGIDZbAhId4 z=j_GeC8hbh*m9g0@=CqP$jv3ZS!ou!KLR;wXar9kj|dcHS{~hcj3NbkF(Wi$LFTwpBlPmDX%1 zXjnp}G^5zHT?sfU*s`e4!PHo*{e)-|K$t}oEeHL@Aex%x*{$jiUppo}KCO}i2RcMm zH<{o?f%RIqoiszJ(Qsh%{O&}|rBL`xMX;-&P(~Q@BW_&usdns;-nn-iha(Z5%UZHK zZxTd9C6*wu9rCo;rMJ(B?m}f&(EYGyR*5W7_n?|-PbCkzB40-IFm*B-Y9eB_*$G?F z8!RLGKvm2B(-A90KBN5JZeX}!RrIiat=WF}R5N6~>_M4#bNUq{brUz_q(u1>tp(@LOrD4HVa@>(E~l`kv-0 z5pNBGEBW?Zo|`o@zvjV^PQT6w@{7&%gqw^p*BG+3{+J(Fzuch#eALi`8#X4Xgo1Co zK?Zer+D8t8X%jbzo5j=jz4OyT(QX}Un;T|sev|UZa^F%(_GdXU91eW z|ID|l4xft4@-{=lTqV-!RPIC`Jw4(@tRE3%LDtD{XrnkJAW*1egjxHGbW*!IFQ%Y-}wjs;-%Hg5ceURzQ~`BxkwLK7X_`Mj-`q>S0)ZQG$Gp<+g;bGU3?{u zWStXaL^_O zi|&TdGm+asZ2xcgc|P`_;-R_5C__Slyx#qrD#4y;NiK|R977_2zFsRkdmqRIQ`~j5 z$Vn^XmCX?u$oiBEk^l7Ejfer+p)rX}=86Ba0fQLu^vmomPZ2dZMuG#!QWbix6aS{p z!h(!v4I5W#=sYf|lkADcpGHfCfC^eaSWlm;q#J}a84kC>P0B0Fr0?&df^=6sncBar zaDC#*!6k_Z%ELdc5U)WRGD)U4v|^G*0{C^x*`8AF1uDQQO{>nU(`~wB1VFEk2O-+J zl?rgaI8g#g@9Bw7cQkNs7{2=QFx)|vYVy1}h7a_8g5gRirse~F8O5TW0r~l5_WAJU z`S~R1NnjE`1ZZWb<%&K2S#=B2!d3)+hw$`=5%nqX4uAKH#tms}z#j@Q7UcW2C$Vyb z3;OL2oIgO~RSxXzcaQ)Bc@UA*@K9jg$SII_cpP6;<@ZFry7t}@w#b6UhhksulsFb{ z+a&zzrVi>dZ{9YQ5z6lZ62rrzn``L^^7M=G`w0vj8XEZFg6F7{vs5MDn@9(+k>rAq z&md3*d-?!vXq8=KX}%K%n=i!59x10*>ZSeu4y$5ehg@OlaHf()2XYY3)MTm(RtP|* zGON~F!X;G&>K4UIUdMaPSRA4$_~%m8S=z~4N+}?gxUt&q-{W((t#wv}Ws5`yB@V0Y9SgRVXFJm$UC+&|z<GsX3`pgD0hSb8wfY{TL&BG0R%6rW&&%SJX6C zICivrZCu3oLDuipirQ0ZvvzQ?BDmWmFtYg}vvvT(43l#D$Bn-!D>=miqXxEQlJ#ed z=|e^x#s<8&(;i#z394lk1p6khL6h7+D()Yo?|9Kdus^F1MfB?-N>102g@MRA#pn zn1v3e?~MVUsRX6F;vqB(TSV{wUjWlUEWci}#Ol=~cl>2!ow#=<4Nk76@7QyYd7%X{ zT;~;_R-T7FbubNC=NmPWtX>tXvR44Mc_b2{Dtn`)tAGn`BB zf`Z~1OEU&#rPt~{l{Ao*Wi_WC?VJFneKrEnNm0|R7se=Zgr%8SCp|SzM`H9_v9N!d z)AdQLUZn;y;7uv#3hk(ptWMQhylUc7w5lWxBn7BDC@Sd=qKbl{s!)P-On*V32gZER zX=RjEsjT^zuY~PYu!5; zkbjURCSfmv8be1(n0f33{C{i%K*4^A)vHUMc=K~mrcMw5ujV<&v|fx+R{CL&8IUPn zky}4X6>VW1`TNi_$UXK;`Q>>k8AE@H6 zX-NZFwFW|^;!WhxaY+NYnR+#^bj)ALeW)a>Zw%^0WO0-v-%XJGntz=H_(O7)PYGCY zaF3*cqyV+eziT7BvKxl1Mf=a-hLLKkF+$*V12{fP5QasgvAkPi^(vvBLP{O`l%E*4 zj>1uu>G*3#;Id9Zqp`57VmF-4qxF=t#zOYCsw7#x+Q$PKEb#j0y1*BQa+mi1dqV>r z0}N@MSRX;pPPgo#~X`hi1_UEa1Qpn3UdrL zbsbrE0d}ZYgj!FNlqU~$4Zfa?%AGgpsaXZKaRg`B}yn~xsmkcA3U2Y z$?8>Ci$z@!OYq8EEIO6cK%&4-3Cc(!%8yCl_d$7sq=Bp&>VMf_a&>;$=lc>Hl=SMG zZNj9QBw3vT)Scc|3%LCq1nHQYB^=~MfLZ*C4IhD#Wz}l0q=BT|+{9ti?>*+ir;nvi zm2HIeeT8PepMZ%(Mq{nY?#SD~GQJ2s3W454hc7lp2f=o7j1Iw=kA}d+8MVaflr@lF zBHQHH!>8can|}e)+c&vP`_C8wjwmV_odct?D&uTAt|;FUBQZ*0)7VrxXOX|anCI8q z)V7i!C{IYTI@QOcaVtRU`eOKXHt(ccXI@JhIn5G&&feif z`$s(90m9*T#DR4%Btu3V&bAzKx=H1Yx&7{T%A=~5JIRR|EG{amJMLbn>r?C+;M2Lh zX(%sQ7=INqV5JCza!r?{SBs%nUnwmOzqxDzzc^3_tAjpK5=nT)DadCPsT|r$(%1J3 zZ{X5xD!EPDMS+@ejx!OYXs#}y0%-eKScH-ykq{9PBQZ?WPDjE^r3%Y6|92@{IC3#F zx+Er2FOKH~1|rdDG!ltke2t7PtSn#NzvtqDK7V)t5*1QpRZC=ohXjGJv#A0=OBD0Dn_4OflXj5(LQ{KT%KOAGmzOioV(8F~tR%h65sv>YA zLY8!7I`rOvwetPf#D7f93Q&hdK*+OtsDC4uKpk3m32R~DB*RR2@gZgwjwN#n*APJ~ zLMGvh5y^7`9U4xv=22F?dDbTP4l7)-J%%XLfu}ibnfuy`a*H%NV?O?EYo1o6@G7g6 zmBhlOEG@~+1y+Z`t9vc7IP4OIlWp!F%e~! zon`WxF0y*Hq(&u2k*w|!fzco;RUW<%IamDPO^Fl^~fT(#gf%btdsP0I><<%ni`==niio7>JUX%FS0s9i&8C$B!8=!7#(?= ziTs`kjqp?$fBI6`(B@t7?D8t+62%kw1d6A1SM;2Kf6(da{R*O=QpjV4i zkZ7zHj6EK+AOaet&Yooo-R}oSqa%Y?BF&{*AJ1x$lKZx`f!y3~T$*9^WDiMoeBbvqd(uSv?`a|Ama{y;rta#Eyo zjB+l@>Z!Y#)nfVC^E}m#Q{{Qp>6ZL`9+SF2)2JrYI*SsMd!u_)kbkc(&yCdNTQ-%J zR8XA z&yFe$3R}iRKCUojn}0MFTlN@D2CPb1#};b1O+R|$2_j>sX6A2dk7c+s+C)Lx86IIr?Y*nO{@K|arZxI&8T5ofWHfQ&gTLx`agtanK z~ZR;R$~Yua3$?Qah*HRWEd$ssJU zIwe;7=-`q$(#fVhEw{`4J2bX~hvg%SBAH<>X=Pk!;tff9b!ubw3V$>`<5}H1OPjMX|4svTzR>c_ zZr>hrnNexanP^QjMi0q*c~UQ;yV$fVh!DO3WRQ_Gkkm#uZBj=Dv-UTub!5I;?~%9f zG*{$0n{rK9j#c5071YKmHuC~xq18OXEcI+emPjpWAgMK?`uv^kG#%>jj%Srd&>HOz z2fPg3?tg#FN7Dq}-l=u2sDcF9NebrfR#uDDHP8vk2spE`80%;Ub}1x|u*TN>8w|F? z;=Z{A`k3cuZ6}1)M2uTl1xW*0QC9l|9QnuxJSk&y0)UBlA{LKv@mO5&Dq|-v?6{K(id0NsKa8>BA<%Le*DIWX21XdAOJ~3K~yBmh{Y!Pa`vFHloi2Z4QZ|1E6U1AoXr z3D9UZ8U07I0mEvC6#&~0B5nSVLOg&C|1S{7#uA*i`$o&$d7El%20`F&-s{H}^F z;Gm!s3QPI8;#7s|R~&?Kq&{z;jPG?Hu<+#Vua<0 zrP++^l!7|Y`AywBPML7bW?T;Sb~A8UeXz?sW7xBi_lk66Be2#U0qV>P*MA|aTh<%O zHAVUAaw8-KkC!OF!4ZQ1%Ek z8aj}G;QbLRPXGLg>1c(@wZ(9CU z?{BVjSGr3PS52i*tSLi1 zV6`3RiuT29mI;_a4}ZUvB<&*}E28_GDpco@cEUM>{(?ZVqZK>Vl!tjqs}tOK&znR^ zw3=89he1t_8{)$`NTSzR{jWNk>TE7BArc=^kwwSL4FrK|7kE`QcMDm4_0)!ku6m5S zma@lt-k@$UcB6RHddJ~1A0V^V8){$?M+3R`yv5nj-KAG^%zq6PBoeDVqt}>VHWE#F z@)~U)35zldE@EGG2|dCzIDRtSd_u2l+OrOeMG{cb)*sOJ}R&R;BH{`NpUemcK;IPRq!y??BOoa?Y7+-9suxvoBb9jx|L0fdRUF_H`+h0Gq5Sbe!(eI~u{oPY1u z7Kh&9J(|q~E4H?cC=UXB?FZ2Ru%GqD#!`tZkDz}2PftL>hJ?aDq_@Cy`M-gAY6s%W~xts*2J^b1G0bH56+4 zGh(~|Ie)*?%w;x6tiH@z93=b$IPOXWfhDX&ge0fh9DKFtm>g&AL9|YJTfC`2?eWe| zb`bG#lI(#Rhr&TqM>g&-!_8L324Zsglntw#B76LIv=Y;M!#C6{PV&Nn4rdo)` zfQ(w>g>`Q_`Gf2!NT^_4p#H06{ z^bV^DLG9M50^T=qoL=uYO>8Q4*PbyDez$>2Z#VVYtd^D>?LLXsDX==krpMveo84;4 zqkpJ2nEvVY7lxI&=YM9N)m55KmA&{|1G3IXx97I!pRX|L0qfgy;*F9$`(d2UC)J=M zF~A6Ozgl8-3aq9fs{zWk!s9Qn>0Pj+>*wZHwf2+^GZa6+?x=REdGsiGk8#6Jyuu$?v@gX)v2|Cq?kBKuU@SN zGQXrw&m})NSXizJeEeoXeK+gX?;n5{yZ+OWSe*i^2OKSV@4}g!i8F+qfNDKq;eUwU z+X(ettbu5|*gq?UvM)jAaVRW(?KybrbiYbswfL-NI7NJD&&EhmZkrt7$d+cgO)<@7 zotIcGz6Qd|p}$_cu`_!xeHvbQ_OJ#Dw?gJ=iPfUBx*f6ln8mY&O`9$+p|Re*8)@YM zPBAU9T69)-K-qq_9gw9x31K>l-haLxI8-9Z>YJf~B*@F#ncu(XgUxD@#(_w^Ft?1= zL~?dsy)bVvIpYs4_18P&kDs?F!X!a{!9^*BFQ`VGQ}PjF&chUTlhLRuhWK%Ec1+sLBgazn9(x zt#YgJoSf9U04lb?Ud_0*+J6G&mDMHJ0rfHYG^<~nc{MDz>f;q9BtBQL5p4SaX7c-n zOH2)K8u1WeEg8bCRq&qj^c}$J4q%mi320Ksp}H$RoG}G9^BnN)O_?W#<#QfucbnBU zYsV^y_HsQQufa>eIys!dH5;lZ+&^S>95S~!7ocu4{SYAonQzJCJAYmPczrXJ6(89U zho+4Hk(4jY4QDfeBO*0ql&G8nE;Fvgv-tvQ(rbUyfF2z_U|h2rJK1OkRza$p)lmIJ z-yOheWWD5{05CPcIYhieyJ0|E2mKaw=xIw$dZ&WOovKiq_BZY;^XmLshq^^IRK?@@ z>%7Tuxlwl@=FTi#V1G4-lTXFpdCF>FpQ_A9^gF!Hw`nVsJ+{Bhd_B#wPB@bdT$M-O zTW;7<3v4=Wv^@voRIGX+v&0W^&?2adj=yFs)WG4A8BAZ-M(O(Q3|XDu2Q`Q-Hb1mD zU_6dERgQ!Om(|B9XnFgfzFM#CdSzdk-_&jLnk+qJw*a+feXu(`fB^6tfP?tMl@8*8_zr)$|D&79W zW+XTEXxfZKC6d)OCD*}fDAyNx2ka%3&N+v0NB5nuxYbjpF3=rBC#J0He+sMg5O_2T zGthW>C9t|4?9?3~t79>i*D3h!u2_`ir_l>NU$Gdkm45uiy&Y3Sb|(zk{fQdhZA#0;kg@yDwH7;IXKBpQo!}#; z`@!anFq30GsMvj5S-ndG#fy}||Bt)Ub z#m@yU+z-(^oz={mgPMfKEjll%76Ultv448qrOnwof4R$zm)zm34z59{n@R_Aa$%1_ zdGJkn_c5cpwqIqdQaW~XyjX^EW@JKSsh=1aU zkhUj77q3254o0Hkp25`?!$j>qQO<`E$)#b3NG=U&lAy(MX&4Zv9D0qpG+dK<^_pt~ z5o;jXii!8jG7l^GVL?#Oiwbq}-{xTHPZO}rC*jKfHGe78^GnxoS$Qj#HZS7f1Zr-U zTykj$(AGO(vP{Da;UE|KOsydpDt}p-)gHUu4>P1=5@sFo)j&--?C{bbeQxA6nB6uBN%k9Y}Atj-X4N9QVxu$3*DKNR$&!LlN&BVSkyPSYR?G zsLL`a3xpA4#=P^qXU3Q>28qbB@>aSm5tY5gunrep8d5q}o82)Dkm=fU;C1t>yUQJz zOJ9SLxZa_toW2IDU*Fu87cYCliHKRDzHxEl=7T`MUURdnnlw}!(fJuorA@`?G$_48 z<>pVro>$eInylWm5x{g3W`Fe6#)>VNv)rlz*nY9R6)#I%Rs(i&(WN2SCJx~{kO8r$ z7`QC!6L7fnm@z+Igd0GwGus^cYYLFpatnTlrM&kL|Jl->fz@AvsN80QIdu^(DuDiEPs?|Rj+tiVzPR< zOGB=}OjAVqb7YUM4!HH_pWphcEjD98oz|X1<=Irz=d$D1g1Yg0kmk2d@7-79f^EgC zX+#}<;$7HOyXio`x+NE}y6aaen?dVbJdOXzj=xo|NeSwr6OB*sBbd)%w5q(cu|&Hs z#+P?YC=W~FvczPy;D6GvpLc0UL&9dY#Gzwkz~KW_Ew(3!C`nS|_Uhgid(~u(Yp5!A z&1$g{j@Hu-7u58Ed*5nUJwWt8I2xWr6(k?VAqX|3cgSwTmn9~vJFleL-Dbmlt?AX`4S$d1dzKc|y4aEux(xU@ zq@c(0P;;VOnDZ*SS^RpPd?%rvzf`$SCN6ndDVBG4508usw?DCHXUr|$_DD4Kj;}j= z(C@8)`pT>xiwdA0*0`;PJF^jWO|p7`@DV}6SA2d#{m57)eO7pm_Dq%ONfz3QG zv0AJ)kiDDdc7Gk%TZKh1yQV)EJ5^@EdJ7v0cWbfIel--iBvy+Cb*xNnI=Ht^4;WE0 zlanL(t=x6+C%Y4SO8YgbxBN-0UKwhSz0$4Hl9j zcv=b>|G};n?@Fk7WiJXG9fUE88X2VLfFehM9zm8cTJKmMbJg7o&>7M$J-Gk@c>k8iEBFfMBrl4XYls!9~<}G{IoRmW(aRWd46vxg7wAWsv5kinh4q| zdx)Zj3IuhbW;W~Kn|Mj2+7LCBt33OfFw9?V&v{qqTg;d$G;{JeWbv+2gm!N(z2O(> zuz%eJd!HLhtK&AQ_}#zA7%h7i9Up)GW(tsG$oREkEhgib1B>@Us|EN8&(S6< z=fC(#Ysa!3l%hsuQpXC4TNTwB9_r_x8_RTUugdRg#c=a`n&#rewM`bSKmU9Z>Yg1x zWWODU9XTqPwFY^ppLQME00jr2X-h|W4u6@9R(C`mD%5ZY>YXn@!Ao#61xPYv{Muo) zvX9lf=Aft#Y?gS(L_enY@8P5VJ@W%D-5-k2nV7P`{!9Tgks-cH9qb1WCa518@%ex3gG} z2`4Jy6<6D-WnksK5)H8)3=+vJk*yo198An zSE&2LD~ktF1;`p|0}-PUm8C}|y*dR}JFhanx@R!7ur?^Xu9o;?(d78*@IqGp6^?{1 z8E)M(*c0jDiwP~nbnjUT@BVh=(!tbrMxGrl^TF}WtWO~|ld`SH~d z7@5^ij`N1!tZ%MgJ^`MN^?&}F-dR)?GK_EX5~zjo)rGskWcD`8nHy%gm=5sMyTq8w zKnF!(^=0F$bE8Cc(lCU~hFx_D5~CDBebH{1(bpK-I^*h5~yF_ z+=h*&pND=qoXuVfvU(JJzIV(I!5N!fM7j&O{<%pzMZHrl0#^~x%X4wx= zws0tNdG1tFh!CZXh;MG97f(F2s)8c*qOh8l0!!U0YcT~ebg{u>{^IrrOIC|hEiy1; zogT7UCtk&{DiUvCwb=19CCH+gQ67hc_Oj-V7}QMMY*veD!tAJ>(NC`tRwF}bNZvOy z*`x{g*j$leMSrj)1O>+n_XB)mBmC;&6GM&=xCyV@?gGlmD*U#-nQHGH!|KEGE1vB2 zvRX8ULIo#*Z}pfV09w`aB<^g+us%rGunpCR{nKqcDH{9m8ta z_LVgwt9cU!I|*%wO0T$J+&-OvvpIR^f3_P~vf_z$%zs}^sE^|If7kUEnbbZC1Cs;0 zgQ~?LBJ;qSVKp+xGY|gu38RxU#<@()K@m0!US)E@j6N)nKkdSBj7nF(t@L9g=1M61 z1r53q|DD3>g!c3=zcjH{SltO@fu3lSe+h7L)r7M0Z#W2 zkbm&H&JMT;T|L4Gy@{(%qV_F{QBb5_6sS8T|JAq9TD(@8pPygoRzxe;^mZt@3SY65 zPN8qnCiE@VL0csd*6smte(7fHM_VH>qv=pj>Yq;Ui$YA~-E=RZPE9H-Opo zeoj|{r#7lf&}uK__Q*++GcY4u8Ub%KK&}gucZFD0uFe`lvzIP`Dqs%)X%> zx5Ei-cBjYLQSF$Xar9mr>hHso(?6{}{OplG?SrSkFFXWF12O$hdb~gFg7U;`n{PR* z56kT?D0mUJy>R6F@YJc>DnR&Wqu@lcZ_x@=je*6m{YUt|MaaZ0knhN&FpsLm@PDet zRH-Kv*Yx!Jy1ZNuWtu&u1Nr8T9U8&q<2#=^0K*w^P`U~X+J;+iEpFQYu(J-DHy@Li z8*VeJ`JwEml6{K@hZQ<`QR#b1p>L7P>WYB&l*wx%U9INkeTQ+Si@YY(uW8Djg|aO@ z;HIA3eMp#24sO#%0qV@I0%vB|Eq`bA5FvNL&KIHa*<-4`&)(i@5#6x&G7q-$eTxQQ z>GEv1p~fimEwWGUKUAgl=KHs2yIxgS6jv0NnMbZEKz_Cn)*mR`3Q+FdRrm77aU3CS zfM>RzO=~Du!}^22T6f_Vvzpbu`^!h>wry?6>1+IZc)IR(vwEEFnGLwR1%J1$iAe|t zA;C9Qvvj~W5+02NRDpCaKZb845r|w9>M%Vw+YzQY=g(#J6j`qpVTPAzLvA{J%zqW3SvF}g!T5Yjn~^K}KUkaNKzK(|v$St=mUkM}AyhRT zq1(mkAQWg!wJ-`XPVk5sn~TjuY>FeNk?@Ye{H!nmw_t1I7MK+rWwLl2j^*AF*5V}l zq)WSxO>TGLoq}*6h z3v|9yH-e4oiws4$VL(x>)_46}AsFX{So(43D6B0!y{pnt{X-VJL)t(x_3Ps7dZUAN zU}krI7cUfV0BZ4A{eJ=s=MVJZew*O%u`59fx{yFuHP@W@A_yutO_mNr#U zsi}L1Q{SXIcW1DA6tTLXluMt6*~%lIjb;6A2ubUmwbvbnUNl*~$AXLwYh^{<433jH zZ3>!tti&Adb>lrn{x-tfgzUbeQqViCIH@y|ET+>XkdZI+iuaZ9jNJ%ATZGLvncJ3Uibf6jOdM8OMy=e5h|)d-V;^Tosqq zF}}t?YMyXDF}VI2;u5PYKr8q-Y-UmvuEM)qs%>j4~YE z7@#Cp-wakC&L;KoJr=zeBQTQzBlEra&MAr2H$?*(^o~NIWfEq*Oth1kdV6%-Hzl!J zbXG6UF)w$m@^qweAS()xwKuxyZe?|lj|(G&T)8C7N`E~chy{J79zJCuE=>LEU-rSL`!jDZkYf{%4$CLNHlq7G4vJX8$@Elj$~^{ zJQb+<$Z;qM-Dc6)4PTg3M5vRe#7+vAbNlt`0qor~C8pzz*@{wV+WMZ+>U85cQvEV3 zt&4L-TYsxkfx17fx4iCbdX=`6%e3fjSfvp&xc0Umo>M`AhQKZ~ZY1Sj?Sk7OOd zD*F=9q>e-NDXu`%s%};*|7%Yza9Mq0G2CPX5-;&odGz|eHmmE}0;DX%3Bz*W(t4Dq z8=t$;VF6;YdMMpE!bj=guqS7#=XgHRR?PCexz+)IPS*u6_ zk0V)KYOB(Db>8imvBpqgsVJ>61g{BoqZx_CHhERiJ}&cMzkK@kvw8-*a5k;CKvS(p zvKk6XZM4NvSS&Ff z1CFox=hlJ-0`b@*MC#rE02f(FL_t(!A{LFqTr3Wgx0lr`4v*w0vgelS)uPI3QBu1& ztX}9_T+$X2OL{bS>46n`!o-8xx#pl2jnzd4>lNm>T#9Rv(N^+4?c-|H+~?JuU`+;|)z6p0 z;f-A8J`S7GktF8TkE>_Y1Nfd7C0Ttvtln;h_Y}BcPwlUAb(KngPCJIMWEEa*Wo&yx zr&~={0&M?5Apal~)PmwI%%sV8kEl(0|E9LQ!Ts z7!Uj6LnEv=%0yXTyx9y~C+!=B8T$m+9%ZIFdm_wu`#AIab{O!-C03^hbqei+izm!k zy&q7$`mXI;Tzjk*v2W3HX*&OO2&zLn()8s8nY4+lfLqU!0MaRw`e${s(;9US9#Yf?6=Pk zXZH?PsGD|Il;qcP%J!VMa@+LojHx}U_$#{$yUKAroiqIbV72Idi?$PI75Sg*gI9B> zpsW~~ESVREG0@r7HTw=(W|dX?Q7npuRnU|%QKos-qU~!kpk31+1XhdH26C})5#nze z1_->nnwQmZCjEb%%YTdOaf8iLZ6IwV_7+BC9u;M`IBF`Z%`G@iW9|9xeh^rFllm3~ zWrSbnHA=plFu{MtrXU{U=J?@4{OBi$C4ilS#N0ectiBFey~Yglwa034`xdX7t}w`k zyV4Pf)hV#L#!jv@j({WW_V+jIjrk;2Uk|HkC@3v6$9!`UCV$%5o?v{Djvfeiv-*iy zIu>Cj2ZRo<0`p8}>Db6P!vrQc-v~?lB7wQKN?^S6601|!KniR3ZXGNt-J4tQ!@Npd zZp#hmO@yM`gyUMH$>>kIUV$Uog{2-c2hW{!WByD$yGYY!Xw{Q`iPfpIde>$$MwOW> z>Nra4)Q@UM^?xRV-EJ6=yDg>@XY+*dzR#D!v5kXyRSBe82PvgbKdzcl4;YH-Bw2ku ztS)!~h7~qVdEH@^t`d7&*@M~h`i2#>q5<*`j!`*YB&7>}n8>e%XI=nBM62h+$TPVE zx&NYW+R_t~Se?4HSmQ)z#3P`cbyGNxBM1hh#0L3UvzYgUrGiC(7%tqV_F79b0RxURz-uuE&H)d{9joak_EE z3K{PsiMu#tyeO<*3K@URcnm8Y=fgVKg$M}A5b~=@qK1rLUAXwgunwd+4)7U>L`R|{ zV`zy)lYg(VD8FlLg#Q}j*U&r4zsI7&aUsiC^x}f{@B)O-l}wRUEJ%Q?>i5Yd8kyof z{f;f1^ePHMXC#uR-_97iZ%lZRi(w`b3iEq9_}hurIy!<3Lo+npK{G+L5@Es&+7V=e z9sDN0g7VT+2x^)?AS^eYIwIf(MvN3jP)E?ot$#A1s}aqA^&F)SQhL4DrchW+3PS|f zd&4GYB-D~)(79Sl5UH6^G#o)3=kG@V*H=b@$$P>-UL%p@8O0FPonjyq0jD@nM-bFe zQA!dm)U=eWbWo0f%^4O>XKI!b2cZ%0+_g~0B1%_;)tRT-3=zU))S3I!&lj4tZ71Mw_ubH(!-mDR;|F8GjBu zmuFCDQGl$TjS*y+i$KL?tY-M_8-I&hEjlQlov3Gg4CAQ^Mgn9H?I8JY2N?>G6iPk^ z<*9FXmmnlMNix()(xfxs_ETg%vc_a}C(os*pv3WtMF?&FUJ!QZ z6Y2lVAg^omjC%CmL4GfvI~*BH27jR&jJ(Z+7BvttOpizu2@p{V8sqh9MvRg~tQI5D za7r`@F-cf2Pj92W?Bv}%zFMqmu^g#$VZo&4SuF5iFj&KPgqR-Y?FFEd)x@Gs$CDfh9DiXgCe0d1 zr58qBzNHP*>lFrt9mDlSa??6*_);PZ$ns=fM0P=;3JYNKkjJFCFe^5qcEWbmlLwBh zvl;Wdewx0ORTP=eW>4^fA(TXzxv1qP!Co>Fma}>`Cb4?uzMN-@o4@2q-#4hN%r{^) zc}1GGbngO?NmegcRxh$zxPJ}dB&(Ubo7E!uL}e0IOT^|RO|;VB7_Y(oHI|5#j4X(b zOVi-h)sx9tiPbBynnAi}XXNe3$Y568cza}_ZGV}8dlkEPxe~I#YN>DW+N`Fp)F*ob zNvalCWHlc$-Wxz40e>L577#YCy}W;$6fa~ve$H z=Com@P-C5V6Vp$_jMidxtNHQj{Yd?)*aw`ca``Wt4VOc`5Fg&5_p{m(y!S>g>?VYa zw^`s-wXO0tv$`FI<$rxMlTGSKkIiNC!eMi(nyiZQ6TD8(Fj%{9z}r#^JMwt{6Vq9z8@Jr3Pt=?jCT`6 zQ7M~4JNOx1nI)AR7Etx8T8tH?<-3K@>#(N;BeDnWIwG%L{eM2Fh4}FDIBaumH)6-v z0;?~Ej6W(bH^gr@s{vaG8GitYW-RFwb#F0nS$-d@YEusx+RTMruUUjsj&Cn@Pwh~T zX4O%Y{(Vq;7URSF^Xt=ZSb&HgG9EpRs|y(~nyh9s5B_$Y!NuWm776E0efho`Qg4zRmwW=KsZGg=*(U0m8l*jJLzAZ-fsS--F(B5u}_l&_PEa!O(#o{s&wP zIA70fFn$@-9ejNF2<@YV-*!yhepWApjHi7Qs|pz}8h@+TnqIvIomAYdzMJk^y?ViS zli=itOn%fadSpsEa1uTiH-vY6ef^@BrzIapg72oq9QDFG8D8ePohRX>c)pvG{-&J5 zWhGC%{(9ropn^p5-4qa_#9vGc>vMApTZx5_M1udGkcU;nUQ#;{@ z#^Pa>$yIm&8RmU^w{nD|P3}oQ<+jk}|F^xX>uDps!oQ-bwpDL?UG*Zn+VyJWEK+G9 zwi#6oa_X>M1*`Fr3x5r3WH7PU=EEL}1Bru3NYjSJqTQBOHjW4akr0;6%_b~$wrGh} z2Y&=H>j;^T&Unn6&O74)^O1y@*~C%bLvTEU8HR`BGv|HIGv_$%jR_y1g#c3)8gWn5 zSp%{5Xup4EI|FeMU1+r^&xI+4)gqb;a~92o8LBP?4n*$V)BvLai>;B-1kA!(o&UgT zafIEBCB%Uwt4{pOi#U*3hM-!Ev|&RZCnld5zl7Rq zG&LUT8qE`CpViglz32@lDni>(%X48=UunN8elCoXUMP{(5>){hDL-ZGY6e z>2s-f6GM3%Im#Bh?yyavxiI#YYZhbF7$sv(&J=kU`s#rLyPrxoIn8!!z!E0S4!XHV zhPqeytxm^PZT6NU&4p1AYI!b9z`z}4E{tNax}bMcE{!q|fTzN9o<(U1ljT{K=Y+I_ z=kK(NVR;FSt;?|->gdD+lim&>DSwWK44X}%VJuQ6^V$Q5cq%L-W*}VA>Ivmy^`TEa z^8dOpS0=9>+tZ*o_neNm@X}L6w~AQk(Ml{9;n`C}bJ-l1%kqbP6b_^y2O?1hBHJOe z7kPrCD?jd5-0GItg#H3LB-|~MBi&sQzk6>BY?(rM*$;E1h;KUJV_2SzyMM#T&@!nb z&;EV!qkzD$TbYIVm_lzd6q zw`b5n#e9@=gCwV}yDb@D9Dg)bh;{OWu*H;3<)UC0RxQkfeO~RVhPZWR)~3!}Gy&o$y#a?t8$O zt-CrPeryHeW-9c=-NyQS8QNWefIl0I{|J0h&*i@3DWCt2%~{a9DS!D6H_-E#SQ}Eq zFTQgf=iNmIka>>=7;>?l&iLFh;O%Csr=AZu=gl+iQ{dH5OE=w7;Hd@oWPnb$J6YOY z$w6NzV76rTaUd&44Okl28poPxdv7;biW#M!u4e^!&w%xg)f(P*)e21bXV z9@NlUE1kJc2AsX8O@9t@y0E2TZDae|<6~Ve0$dhfg)>q#)E-(j#gk!T)?1&f1gMH> zC$zKQR9&v?Y|p~^jvJ(=l@QMRfvrV&iNQ|l8R0G0+vo|NyKn#pa%8)sj8{)c{i`p7 zcDA=Z(E^**9RIsrx(8^3u86R z{RE96hIj=ee?0Z+Pq|{D=BbIg8qlo`LcWcG4xQgwkrb>qVp})>L9TO=CwzTqBD>I2MoP4Mt1w%V-!Ur zuQtYvt!7(?;12);R@=14DnQ+AA=_y8h#8&SiSNMUa0OkR`#F#=OUJ8OmJ!P@LI%PM z|1s(9*|;!wd`+y-2v7M8+}s%)&+?E%d)a--UM^ewRDWFgvWOOYIpHX%p7RvtBjS2A z!)^3;$ytzCUPJ7GTb4Kla^{-M3Px$VHWy>a$6Ks`zd7mEQ62e&lqac4kGC|&gs zcl+E1Uw_vVx8FVUCVKTG(DXuoY~$Uj4gcaz|HNq5Cfyo>Nc-YL|5_qk@x?2LI*hWI zk1iyCa0zPP=ZR?;Mv-`sfd00{Ibtndei?4hyop{t4&}kRhN_TuhV+s4nm)bVN(OYa z;T}!8&Bkce)NAnSq{>OIeQTwn8YLJf28i&yVA(5uIxiu<@Byg)K# zp<(-_znvT&HZ9p~4KP#@3si#X)q8a}BrEy}xEcBAH@7qog{2B30^4^iBrL$y!rx&P z&VKSHdi5lf&tB6{GsH@rBYUoq(T13c32nEw>lT_#*MZXH{NX6wAL!g?b!kg+t3POzitt>J}*d$2H^o=i=03sKmJWO5^u zsaFnlKcq%h__4`*94yCJm>ii&805rnd29t>e(Z2}G?(589%bzNY`wB6h31!C=$F`J zx)Rh^m)t$A&Cct@e#wKJHvKm-1Q zk+u=Jwpc2&aYvv~3oTa6bNOO-UMww1tqY6KvVs}CGXESF!Y`bS%N=G8EzA13?UUKc zE3~CE;?XWn-v4~fHkvzDSTQeNrwyg2uU2pgQ)&T3sn#nJk&_WFK3T}2lS{!?Du0dm zvn@&LR6zdhtR2|BB`?%^g-s!awM4c_>P}NnepANAtIy|u?&g%;E}aD&2HRr7wH;GFNp=`*J$l>Aw0?3{cQ7+sk<>4%YF4hy@@S46&2D5JOx*HJgyiVuay!~1ng`K-BiUt3byjry@ zcDvPbrLZG!?ZfXYFin-bZkQxnVUaKRZ;7(jcG177j+N`f>X&V^Shr%IRebap$9P_U zhtDRDF5Qb-`}eDI_uivo+WbpxdoyzPa7Dd3a%9;@;1bM3lQqxkt@vNT^~lAE_kV!m z`e%yWdv?5=yxO$j+hLI_rVLl&M7G)gUi;wzR~6^M^Rw3$JbvP=#QkXR%Tv``jkda` z9^tIc>XzcpUVcmB$(0ZB^;~RC(o5EE+_~}YrWc}3B~Di_y7mwtZrUMHrN+jTAK*4aDDr<&}H2KbLguY&NI;M41?Bl6IcFd_b4!gb&6F?!Vv`>Oum`e1qK zZSLCnE7sRZ{`_2=a`DThZ-w_WAEII ztvLNBQT}3jLLldgjhe|4Sv;m~QqpZw&b_?Oy$g>8Bp(h)Ua>K8h2a&6tQ?T68AyRG zRJskM0wR6G0H^{gjYWU_^uPR)HDXLHLX$lw3p$BG?zG;JpkD8rb=W|l^}A*3#cdH@ zw|xZ*H)(ufdC3@3{e(p=jNk_GRC9wk_5%R>5-)vTq657``u+ zH6T}d$+o2X$Jc*qmi;z6b~%S>i^g*2iT49{OcnK>w>wZgpJd#F`91klMR?s z|NN=Pu262~_iwavbz;+hfP^tkQP+g16CtErp0-`QI-bL%mwCr*hfZ_SU&I4*89 z>i=D5wqUa1(%_FFhK1L!?_tRZn7Xk%!0_pugHHVtutq;@8Yg!vFXE`X>%LrTpRo#}m51 z>q=BvK&O;5GKnyVFaXaf2Om>DSt-c~60|-kQj?34L?-`d6r9|h!liIE%sm=-Tsa)b zz*!(h7sKSfWG#r!J;_pxM<)MI(u8p5B}p;^7~W?u%a#BGcK_L zL!udYaSIQU5(b7PJd^*YNY#TpjeNNeH;SUiybKJ<`FSO&c_n%kxjC?~gx$T4d@T$x zc#(j+G6O?yYDpqCUC3w13!pkGTy=7OsubAeh~wlL7$lHPW?;zBoxCzt4Xg+`qJg&) RA%T#N$q8xdY)3jlVgQ_O28RFu literal 26253 zcmb5V1yEeyvM-FgyF(xloZtl4Ktc#UxclHTxCD2%;1Gfj5C(S$!5wCB*DyE)2?TiL z|L(bU-&g0IuimcOJ$t66SFgQS_v&AF?^aVrMj=5!z(7C%#AoOm5AflBLEW#;1IU}s_GVdw0`*~!|@2ITh7Fz$Rj)(*~Q9#(EV|8HE+!a(L`|A~w0-^g-tb^*EkW&MAY z=Hcw@@Smm8{5xrG&NgmV?(YAY^WV+$uRIqsCo6~lFwcL-=k8(V0s8-uNB?hTYUgNX zW97~xYvAw%0=PO4uCp&8^cMoni zOY8B}ai`GN1YxJ*;Z_q1(mbfBZmc7%z=9sZ2wha3i)^B`u7p&8`qxT$0d%|OE&qB# zL(Z`o%}^|)yjM%Wf{l4Z$+q!;L$sZ{wPaazX`zXOKAZL&7+O-m-sa`R{>CIDoJ$zT zVY2=Ut9SOLxM~MuFHFQ$31^@o0RxjRUe@kv$DiuW#1^Ktj=INTVUo`cgGB7AXhk6e z%dAPGGqQ;xIaoR#^TSA(M<`9(N9BJ0j7#-5y+y}cgQlIcp=j~TeS_I@($7y#Wr_I`wbWL z+KRPm%IFvkH?}jVhzJOw$Os7k+XnvK5M$#k#xAu3JPPe+U~ z{YDsL$E|IICUsNLC*D%KMtXOy&L`7i{h-H6ogZF8{Ysm*0(W19G8gQKiO~02UXI32 z6B)-02iQ|lvYATKcW_a@O=uQgBUExIK}nd~~}_cgA0~bXO2*c>6>)7DBNWaAegd=X_!4JSL&? zy;_R(1h7gnV^RNf7bkYe=K+9>hZ*=f$PancI#6zyqU~nQabS?E(GPw!E8`__JN}w?U0ONZ6~I1USjQ@c!|8@Xv^TUxr&In5J1pIH11$^IXta? zMEt87No1->yU(g|{~uN3uVuMgd3e}4*|`5zk4}Si_bm~e!0zrZeSYLW6CFnzRxukK zTEo91tWF%~yhFK#FHkPCovjyG$~I$v9VPNt4Np=^<_x%d**e!MZTmmn9 ze}G|G&dB{rxTMVN@)q)I_qx_zknWNIn2a?`@l`^|lxxjA;mp+zSd?Osfd5s0j)Z>& z`ZBf`>Y%HMIRvw4yz!dPh3uxcZd~k^3N#8;q>t7w9?c&8N}Wk{yMn_jj{=QWE7N@2 zlP!7H$5#C{Dss~^*Vj)x*F6L3#@^qUFYbHQyy04{`SXqM=~}ej>i7OiaQ1@ zrklGJ_*j-1pcVioKGwuw1|djhIRzcVcMtk^182}R1rO!IT+!m$Qi)&NQ@wqUX$tYM z2VvbG*bcV=_>pNzW%7UV5?kAx5ArG}w8oj@O_$a;p=bG_Ash2}y8CeG`)OMUzOvC2 zFF5K>YpwIrkYFR4_c?F_xq@8lYIXY*k?;z*K7upo=ic;kM(ZG08XP z*@o20nfT5|NiWT1Vg;r-vpipOX1^aC!-H8+B}xZv%ph3@s#K%WE~o?sU>wLD$=9be zzDx&ooDoq(7XO-7-biGi;>3B}z~0S`iHIRayp$>TF_(fi1bq-u2;Tf~r!)KZ$0I$| zqeNHyh0H~x&<})`58A*Jt1u920gwb2!I=yr|0Thdx2@*!?p2N~uRUfHJ?UHl=DO`Q zUeWHm1lIn%Y|@b5QNNvb~ z%c;oiq-agC1y{li#jb-;X+xjzBA^*MtNVS;mx&8KCIh0*FiVvu9DWmM>mbpTO7#}v z0#s2U@I9k-umBF?A$g$WpBMp+YS)TW3RxU}-QU}vhiylDuyEJfiKU6IAp$Jj!wc>J zQhCB6#U`lSuIL;Z2EAiR&MVXkZT=-(?>)~Y8T~`djwYV5>tT@3U=*rKw2GfRtIwOw zQOa=D-7IrOhMt<_2Bm)U1>&*kRE~3xF!0p zhkBQn;B!DcZc;2GJ@Xf;A@TOupfvmtZjpgSzpW8ttvu8$@2c7wN9t$5 z+~4rWAF!Wt(9iw5xqmm9R##x-taeq{pEkuPPrTYNS7%}ZTY!^Lp5p_1n6p#qj{9y~ zMG4oQP)Eq^;P{6BOna$D233EC;RI_$%mDGt@5@!$W8?xQoZ?{ZVIW{H_)|3&>NxAS zt(oDt&{J~j18vq6jH_-eLGvwcF*DhQiDgr&hM>Ssc7apt$Ury_;*1z``xI1e0Y>|P zU9@U8Vc=2MHAC?$bf9^NMz8%Lhm@S+$A=xa1oL9n9~T9=#T?TF5cYXyU3Ikl$YWE`HxFaw zJ5GnichwH{nDtlG4oA07F9_Q-6GtBNs742|`TANC(udP9O)meKG#%gfHSv%-^&R#7 zWQQof4Ll4*6wbr}!_bJ)$qOQe0^y;DnC;uV@Lw~OZQiAXCJe>Q3xx_K#JDWqwQhkV z%P|T84%KNS_cSJpc12X2Mbl!AKbXvOYQBCutAD>PV?f8Z>C>3ML!*}BPs2WxXaP^mxM@(Wn@WZ zJ|z^i+-#GXigAarrJ3@7e8wUOQh}GJ6a6H)k^v_9rl%tjY6FT*UZ3;k>ee(=JOefq zF*QD|66GkM@JsZBWs(&gUfS>+0WhFQHBK7K=hIVduX&64V}rQGZ@!uNY}1pB_&l|_ z-qZhew0?yjxOmVJ5dQG~3xoYD6q?tY4_OgFK=^z9jb5~DL5}85W_AwlJRbkLJyq_52sycS`aa2ndKk1Oy}mjAz%4kQ+Sb^88_~_CZSl2?+@s8=IJzn2L&u ziHV7WgM*)+UtC;VUS3{VSy@w4)4;&M!otGd-rn8a-OtZ2G&D3OCMG2%B`YhdxVX5g zstN*uw70i^|Neb+baZxhc4cK{dwcun=;-qD^6~NUSl$SWwnO8NgJ#PBQ@=zkH+s}IERf5;>P z=(6`d3GsatF2lAp6#`RuQ-J3ug0mLgh_cfo?66~+m7kL8bP^kEtJ|3Ak}OcwS3#bE zKCUlJCAz!B-FqguxhHCX-EX=@5-sk-M)|Q_m`4^Vk^DfV8(T*gTNhZ)QIcYVlOBPt zp0mXHM%jZ?}X~;@;C%JU375I1N ziXjB@f7g>PAKf+kfOsJV2CUt$@zi*{%>{(Dbz)|9H6vDZ)I0Q1?_O0Kqdbw&38Rw6BD3KfTb? zW_O9VC2RD(o&ukG9zvrDDY>?#hrl@+XL5-iv@6uo6@> zFfOZBX5hIN1ye-iy@ec# ztSbpRMb8}0b#t-;xo?4K8+L+Ii;67dQz*yYaBo5-RkFlhX4z# zAnT@?3J0|eZ=x11>i9*RaV_*otA``C=22=N5!IHNI(^)wLR5G&Epjup(~cu@;f+k_ zyx;O$a7;aNLp|dJ83nmbvI%R6_;|vbM77CFc5G%-j5+{6Kz7zzdJfo_$JEc3eW?I zs861R$A=+Lz7GrHj7|tL)Gp)f1mYY1Ey8we8i9j#i<%cTi{IolwYP zoARJTM@M5(w(q_Nc>?$u%_$?1^*%Lt~oeA_fa>kG+t$Veb}|J0g2R07};8a-rVe^ET9WVj&4pEU>DXF zMyhlF@d7xjMXovhKoeZRw!A{z?O{OVd)@0+Jbqkc0+}XU31m9oTfD5}e9(sxEN{9o zBhD=Kqe9wNb6DYejv`i!;S!U?~^34N2? zt>71xcn9q$#3-~zd%0;TQSl?O^*>(ZUk;=`Cx_k6tK3%Nr{=3l?cc7-1{9mBO*BBq z^K)KI!S03A$f)g7xc;H>-=5+LMyLCGGv#X-7IhLvY02s>lB8b*BzW z`ypPRH(f+fmq@ktz}Gt@C=sn3RXWT{7VY@lS-BobT+X@V65e>WOghJMVx+i)n zQZ8hlXK^!$^v)z}T>Ejw-C6%Y0V3qG(JO;sBf}1JMS$=k2~mgVbV|Ar4liUkG>8pg zBcmqQfk>2q`N13^u98#MV|Xi-<_Bx`4x8+;h{~$8BokDd$%vnRz0kUcg6bgr>N~+T z%j!bYZ)7Ou7yMw{O${L-^N)w#D2?n<*TUtobvfJhJV>CawZxhf+Km@qUV~U)bSlW0 zSq#1KO?x?jY7jXrpghoCLyeSs%z$W~ygneH`2q2+=%A7~KZ1x+B$d1-_8nUiLIoK! ze+=46%-Z7CYELL9l06kp9;a1A_jXBSb()P^OzrNd^g|ppf3*7u+R%ca88L4BM5-+U?gD=`5*GNy!XaoaN zh@hn1qUf4c(CT4IBb}GR*H_S$SJ_MccWCRv*pc^2fq;sukR|OJI_eiE6?{XFs?xOM zwv>*RDi&nhh~xHX-+rMAd?!7U>&vGdiLma}Wbz4q`zGWl#a;XJmj682K=$fhNx+I8 zuFP2wt@q_^tSR?yTdfudV$|wLt1bStl@kLad z@xU1(z%)&788s=s4G?JNjKFc6&{yQDRTP{h<)vL%vAl))DmJ`1k`+xzta>7U&M4%B z(MunyR6pTW4G+dl{A$5p#;4U=)zKwj3(Kau?!dxVb6=Sl7+fPT$gDzm9o}4=LuL%S zK5oOHhLSn7pLA^c9Ed^Xvu3zHerbloxchLYZJ0%~y zm}VZ2gnXp{hgP}`>vI#8LF)ZSGc;+-NDN6Cq8+HhnRuafGWOKaGfRR zSO@^nPPfXG+>AL_>7=ZRq_Lok<=cIYM9-59Lp~wUJRL1sdwZ%byAIvhwT+~T#}yjU zEIj%4wQi?e*XkIxn28X$Q+GYkDj3}bAiJB%=t807;1Fl$(X=w|psli-;ZljD-4^Zy zmjN6`queMzQ*s#)uN9W`4YykKi*gx+oHGK}_xXO(){z#?)>JDs1aK~Ui|IXFrFT}Z zTfkujyuU&mq|2%400se4#xl}+Y;bd%%(|Qbu|FTsl<7f`<*D7 zkjPtD?Snj<=1txEgGeultR;t|7BX3eqcU)yUi6aPu}$AcT+8P>cnc`7oKKW+dX$=k zZ}nY&r(O!P6tuNrz+&Z)f13IQJMJEVOIQg;GMc5%YflYX&%7%avyOd9DHpxkh`{|3 za9XIt1U29XSLbNt{V7!^hT67#Ly;*QC@TZ6$<)3rXA2L(nP+AS8XSNJ1Fs3_;QCJs z?IL;sDQ0xLYOIog&6vh-Sg6tS-|M#-TPI>2&2MiLA-<}5d8+3uGlI|0p+mk5qd2IU z+*+seZrth75`=+g>!FN6YAzidA{sfU4ORHwS3Y=K`~Mu~BsnM@c0U5NtwZQUXSzz? zCs2GB3b1#mp40N>ejf5maITvvjV3^~^NzUg?#5?#wt9%IN|jape7E#K>qNZL|HGkT z9)hZ$y|=jbW)Y$lAf9xIc4%f^O6Eb1NE0BXTuUdMRfq;imuwh6AiT6? z8<~J3z`XY*>IclKTV%HPT_-mXPiLAj5>sJi2e49FG?_qztYcR|7_sz;aXH6Z!EDJ5 z0?Rh?Q2H|VLNZCDP-jA^GO*ChYM)S_-6;>FiZE@vXTy zPR-h9JGB1KNjkj%+31U5%{h^tzOSE)L|a#%9`$n}cM2nGsxd}KITk$@l?Nifd`)oW zVR`(u}?~2XRP}?<@Z*(N0TkX`nbG%AX6=otYG)%UCUR z8iHRhkBZy)e7gJPPKR~=UQH(>ceZJv1yDcd64_cdsx^MB${M!yI0Vm>^9Z}k(|y1= zKfOIg2N866Q*%(gZ~UfDJ|^LA3@f5a&(-7C5e4qfv0~Rel$ry15Y4-45YELpneB~c z^)H3XkMrUq;bD5%k1&wn*y#6$hxogOV(=O@+y*OgKCJDm?G|oTt}LTP2qakq)b1v= z@GsrQs9mZh&yK-)?)CpjJc@OZsr$-X#1<90i7JHG{xHR^vHYR;EmZTJ&29`{8%16L z=R7i$hivW!9Ox?9j*-;F550P#V=%K4jh52{bQc*vAR1h+)oAYtSe-&Wg9|(g>0j#S zOss!oRqgtiK8Py{LYe=Ho}ALqE~xxl`v=Jt)1PN;z#y0cJP>@*SdiyWtu z4gj^9igAD{&wBkvP0^%;kd-`)n31YDsSzzXt?`0JS7^Z2I0gIzxZ465U_MEoS2_!l z0dzYt!8@Ds=*IeNFP2&TOtN9!btwtiZ(G+t9K`>E^N3s5O2FRUOKm(gOtVy}&R6Y* z4tW0IlL|h%ak>~W;?)Qq?hPo{U`SQ8$OuR4xb z0sw1TpZu*lv&F|}UoC}JJ60`A9eb6+)Dqh1%kB$K=UuHv;LRM9mRAKS0&i!((05%G zSDSb~`S;vhh5o(*ck7dNs!HCc+di0v2EvRfvmPmx1s-&Q-sx2v*P2@#Az!Vp^*vbQ zzQi4_%FjJsB0J@xz~Wnp3j!{Ea~<=$w0yf%4{p%bW%i*7mWuPL&?Lb*$nOPq^jPRF z$^A%~;JvX7rF%|kPx#(;~32Irq&p> z-;`iuQI$*z0ed8U8o4;AOE0~iaB!|hsAdhz_rRW?IJG$78=n>toL5l6N+FPKxYdE!C&4NCUA_tg zc#Iv)RkQlX><|S2wGmkOf#KVyY4faVMFe8EVIhF7(fNx6U;lt`VP# zjw3y})~Z|ryt!+!Q`&h|%-i*E`aYJBs)*drZm;0L&PKX|tGbt1ZuCAn;ah0ZMjB!m z{>`i|YXZk$+zXjcINAfWWa{YQ{fZ->qzQGMk@p5W*?ZL;*OFjQscrN@PhC%=uf1yR zxP+ecnSFVobsb;L=~Zj5k82C_5e=lWFqs+w?VOQ$7t`pC25-e+j#=PGk7HOp?vA5L ztQ4BU3KeYv{bYr1w^S8 z1%0Bu0xmhyE$MA>irW$+&SN$-3D#!|0n;(Q=uj*-@^O;^fyWUDRS}(&!*se~I1;-f zUZmfYKUgKA=Tkvivb`{AwQZUh6<*kl<<+DkL!~db8&Iv~Y^~j_qD1sQqsn%~7X}r1 zQEcW*!7iwH(%LF~b;W+2C74v9^X%+7>f4@9_fEBshvCE{a$CRe@vbdYTv4@G;ji<8+_$c?m2GhI1+E)k=sBU5*mf(qz6NWeJl zBT^VNGPfes3o%aJlPx0nX3Te6Ubg=$(j5=anNx6lGyR9VKmhC0yY83M;{M6rOvpX&}Rd7k73zR#K!2jN=FC3N% zs~rYvUGPa4yRuTgjjBt$=;gT9)2n{lL0KrDT)r7RRNnquT<-x3T!WS3F^)l1+2Cmw zAI@D04nzgKYB0apic!NXa{5v@AUrn=*D(djG*r20TMDwr1F4ly|5)f8r9!B+*Q?mr#;=2iy~H6&?+gMs&tT3rj@JMZbNn=fU$`f+S%CEXOh}^ zd|7t*k@8sQ%NudG5qNFc(XnvWgxtB4EnAK|moNVN5k$SjUq;jf+wG6!T>5Db_dNKd z#UdZ)mdvdU8de!b<#D!>WNsK3$UM#fsw!8!}{qCGEzeKn_w8bBEJDKGeHmH0s} zOoS=fABD%%z)|@dgkAf~J9fwf-~5EwoCfM?&rbp$a<-^8-VC${w5(o~{kRzc=4*m2 z+Lq8Ymms`I@6d%0aWikSE8+b@*56n%qG9seFG5N&b&pSMC8=9-kFyEYyE5+MI+|(XVm@^gQ}&Nipi{{G=;K$R z@W+x>{$3-%GZU+%N$OKsK`&Ik{k9>4IV>cXY>D&4{aYJ^E{yAqZ2#a4$uzM_7bnL{ z<8KjTB6K>IjbrRCa>O%W8JW$oCEdynE=2&op;OMqSFmRHPRrr;6i9u15f0}UA<=@e zR`0$~&BOg}FKfnyUPuTrUD;SF{Th?pWJYM;A6ey(254ULtIo4VnO{;eLy}V)~H5O)~ zMuZ9BUu{u}K{3p)3!N@WWFK+BfgeX6y)>V$-7(K~UM2iv>ya0QTi5)GTVenQ2bvN- zL3Zk-rZ-EjM9>?hf`S?SG+wDRc#ennU=3m#%qKWWp7Owx>?6qMXF6h{_|l?0CDbt+rf_zNqvyTp&+5)5`|rz7rgdtFf#Q`Hcho>;iW{W)aC#fv9cQo;oOm?VtBKqh_AWvRN^C$O*LUaQwoK+Fea z$dwNbSYDmb$gbw!SVE%Ajypd0MsChX_=8aIXl0IWfE_h$MEyQ;O-dWvW`?3mMO;rk)V_|?`3NB;`UejqS&L+L5 z=l@cK+XBfGGyYyAQ&buFP((tp>7&+sC&jd&u?)P<0OQeUq$p4VIY8TH0I7dOJF1`$ zKG~@XQ#-#AFQX(q9Nn6|v5Wb;Zk@C-%usD|9+4eyXzS;%rb~)W0$;OIdL>)TnMp7g5VgYN??-8Uq)#-*V!%C*kQGMPN5<`?QD zN=32U4Wy(+H4qN%P~x61Q$Y@fi|MdcT(=(rhSVBsUm>jyTNacUpdKVbD67h&YK#LI zfJk&^X2WXNUw`EE?z<@E+PNj<_VMPBm;w`{4=ykT*Y`0=O!1DwhfPvHTZ} zd*DUqvSu%b1bUkF3tfo^e%q?Jvr6l~QUA0cq_u*g6oqR)jk}jAPT|~MH!LOrzTY;? zJivcWNtjGMCsp#nf#WeC^^QF7TCI7f=Z9)RD*i-+DYUM3U%Akhw+ z*FS`E;=d;kVzhicPPGnjT+`AoXKo;r$CQ{Ngr*jr1_^k#6!wfzo9iXZVgK2jxBWm4m+YoDa0*zH=QbRlRjcL{kCB1_b)pV{&pzR}YH-1T?s%96v z0PIXMEP*Lk3&FJZEfwnI#-TXJW!g6cFEZ!60S*LE^D`D(_^Jg!IjiW5Ubhp+z=`82 z7}nb%R23QjhpA5V9NwZ-!H6F2zJ?Qo<5F9sY*JmMaF-y`*a&Mh(EO^YUiGqG8cM#| z)YaektC9Wqih@N%m4Chy1vq@h0)ma3>e=*!F6oz?3*_WB&ZoiJ5(EPo0Nn!N&>c-m zSlJItxS!Th0jx@sO0zb9ZVTP~ipE4@P)8N^RWB(J^WG;Ygw?lUuY(pU5Zl)I5~xCMQlU@eUhW zDDh@N-xP8u?8s31md%|`t>o77fg`uOlKYlphVTbe*`E;x?& z$1_~|ls}a;qNKo^Udv~MRA&4D`vpH|y*kfqQBpw-tg9eD{f3xs3o?;B}uB9TV9ivld_4D zGh!(B$qCRqq1Hm&7~Ltqq$iV3r;R>mAqSW7=h0+6>Gc;4HdxY|dNH}crPY1F$!yy; z;0Z{m$MKImWU219S2s_~K~S2wu7w-xlo~3NP=a|F&aI*y4=EYqhB$23e-qtxotGl0 zat8~d#I()Gv2qF7lH8TP{K<7~sP+lW48y6Au5?ZN)uwjJT2;r*8^i#3Vw=9r`p2bf z9>BP~h7@-%jZq&sCY4iRLEMRw_1hXw)HkmDA0B?v+=1u5)b}ydhhPFl_;nj#_iC`q z?3-rgriDvOW1B_8|u_l8s7)ncVW`kS<8iytbS97ZLAuIys>#+7n!mdy8-JR zBLTESp{-xkLY?uNeEJMP2J*TPx%M?Gjgf4kJzU0@xL(dRI*D?wpLDLx!MZg!Hdg`b z=I=HfJ+ebzLz}%ZtT+KI^#Hxk7TOO5s(K-!BMmZ+nIG3;+1LX%ka?9=`7DX|A${(Y{QqQp#P?S>2Tv8&Bz$B6>26$eR>!X$VXTGjiV%Pq%u z+^`nAd_jHyi~i1_{&}%~zVkd(`n2O^BY4F%upqQKb*BVvjw(!}uu$dlv9aQAnNfax znm1p$qr?6M6?3}9kw_r3kNIrU3;Qz%@jWyc!>rO`nmZ~sh@HMi3QAQElE72>8{OPz zzDl&?dPIdj%t`F#??j3%Iz5B}-gE0a1e)OGVF}JId2rsFmIs0j2qpX!0rb*o8d+V+Oo8cxUHn!&|MuX5+a4$lP7m*mHSdYxt9IV{*6vSi~N_2D1epl2ipHnv5m ztg&s^nzPDOsYad>kWZr2Y89kS>SLjQDLam~zpafrR0HX3R04?ef(q5 zar%VV*;dAT1+TUE?r#PVp6wbRXS+^y`B@L~Eh7Iltx=>ifbkp&GFOqip+a=0!!w6- z#ySYMAK0(ct*(M~5jYN5}i6;KKNb@VSMlT~bi0KZE$%8%>hTw00t!*G%wKZ#} z)-xdF>hv9YRA(2uf)B$pWmO1Ez1}(0#IDl^(f8Lvl__5v>0+S8R(5c&QZ zNjI0OP*UfK>^DS7MVp=^xz4c%IWyHW6ItAI>++gLO@c6fdKu(%8m-Hj3czQb(@FS1 z(QJ~sfF)J&X7X>5q&PY1H^NjYsc&m`pC0y{5p5$=N;|dZM;gvCyf;K>-o!vHX6a>!_AJeKuqT zcJv9-%gX@jBnuBxa#QgPoAI4UdK+ald6zrNIclg7wFQ$ocrDzvrT5>eb`gL!py&!k}YF@{WKO3v;oP)Hh`>Mj4 z{)}+>VZY7>cyz~YkDQ%-!~gj?aN$dA(7M=A`{wgX;6c&DmSUSe6M0*`XDtgI8`GO6 z=la7d&)7A-t^Z+XCXI<^hnPw#Q%!@<0VT#}u zx#pjc8?rdL`W0KdAX>G(J7+krN$jh%GFRyS*j%%&kD)Y7CZG7NKoXFnqHKks=sT?e zja>r<=?$V2^rABWl>Pcu+Wtbb$jLofqm>T@gn$s}>{jQ>#o00wmbnHWd2eHN#x2S- z^PIP^k$vcNCRDE_soB8*9nGNN`BTVjqQy+x7TFkjtM|~MH|Mg9*{RKcatp(Nn}?B> z^!ZN0bwOt|x@hWz@EA3wNoCItWz#F|!hEVBDe#d>pa0(oX+6Cx@^+BWhwH~H8v68S zF_62df|%9Y?ay_6N~1jFAL^-ZveZ(EWy?f``w!XE0K6hO^Ok}q{3k_y95L{alnRv8 zk_Nu2lLu&3K|gT6t*on`i0+Pz^oon|4@1JsVy6`n@Ukdr-_jX}b3p92k;pGSy#NN` z>Po%_Bi&4riQvZRG}+(MXU>6^_)~L;ksl~7yV#)p4A6iN0IBW9pIA8LF{iM5A|Pwg zCbvldyle0i^z9`}*vIRak5sXPa_`4@)2=0cZ9Tg?p2^$N0-V%RV~H#HWDhW1 z3pWcChi$~pL_sb<{SpTsc@{@ubd~9W+J|06&4bJ0H_;os}Qmk@aT=u0Jfmnrj z)$b&O_(+C$a?WbA^oSA`rI67=B<$GT_x6onc03y&5I}y57Yx$I*^?4b$4H`M4A9t{ z0TuY$9b0yiNW^Z}AO+N}A0bOtU)K!G1y9CE*owZkDSY@`+fUBscf7ehO}BmMobU$^ zj(BHK*gU`Guz0WO195#krJGhuAY;LXSsE5Ew)!H0`4=ZRKq1;7 z4h(+!g`SJ^r3p%?G>OrT(ARR=vCL_67R`BvB69ziY z&q*ORd2=Z9xMjtQSz=8j!?l{4qjUn}vr zW2`;J$Ql5_4&q-0Yd+;2>m zc>PKWsp>)0(tTxEpX}B8y8h8l`|w+en&R;xX;L9pZX9HFUrvRW)8tuw~8zV)5+djJYRu9b3qN%~inq)nNeO6oQ4FBwM$_IE&J zI~uI{EN!DkrAGD@;xjxP-C(~&wQb^_cG5(Bi|K2H@>I^s4q$9wg&ICJip**%ycg2S0s#tMg!o0Z_LFduZp|yvQY%rsu1?-ky%Ob`b zGg;9*|AXz0 zBQCu{(aFklIo>w<7YVX}z=8#xy3wn>G!S-(aZ)x%`|QwuwNH0;KaVTKL-ip<#a zU7c&BBno}5jgNM4w0SeP3+3^aU;O(_LHeb-0}-jL8602)~+6{cwvxbq1U?$0lo0v>R~TNl-!T*Sr=M-X(ER%mNa z8`H>9O8086Yg_SP3%0Rhe>AX{bUd32d?TlAN9|IYmr~$HQ#j(ZjaQ-Z^#cE(syYSHv&;8 zwDAE_UzEgffs2_*Z8(e!nPHddxjMqo`4FsQ+QO3|;E&l1*x@+&pMWVlxE^u2r?t}I zz9mS`U{n}P6B|G&Q`D*2gFwxp!hBzR>d(Owt`}{RadDs z9AR1OJhE-DfArST;`5)>@SwA|!D;}sAQ!D^-~IH{TSBV%U&w>GtSww}Z*UYZ7w}so zKNI%y6%U+%uSXY(on0r-VTpHSzvmQUTTqs3+G%-bY~ctmuDN1Pg0Hyq;0(#qwNbBNb&F&tpsam)Vo+cA4pvZvx5UaZz*O$@#@n%n?&!h6c}!;6wRvh= zW;0=)g=T4ay=YCdcCGArc6ha$zT`a>OxgIMuC}RdoEI$L8QxKq`j)oeZFMqKIM2_=Q39^Sd-rpP@R=M!b@E zd*Q5;Q61;JKg?w_#Zwl z6p(i>6+X8SA-q%gC|@IM8uEYdO8?vLp&!n#5rlW^% zs}3h-u}xko8im6W^tRDWi)vq_H4Z_KcN1rFU#y0!u1<_xf9`!k{y~Ws+5LONWh~%n z+hRfyUyJ>@or9H9wV04gBe~ApkNn}{%K4n}?!2#HEp|Mj#3MbrVZ^S;qU5>QNBDso zIzkjq;5Gg6&`mHaDuv9`gLB7|FXv+>@jY$pn+gqgqs!Bq`}062@9syxkOtjZMTzqj z2-L>XMD-5f>M&vusL&-IZ!((w=(^sPD{f2 zDZ8mLWzx|n-vzupY_Kc)MT%|Ho&ZV8I|w~Hs!y-LrUwe}r^gQNe#rO?e~+<>#`js@ zdfUt1Wre*tjr)4#W9C^c-|Ji;p9j|tZl>=J_;zmBVA!oSm!i^UHL569oSn{DJ`r>B z{!x4M=6HT8+~_Cmn=x_flh>C=Lk2^>Erhu4BLAzguMCT0>9!68x8RV$WpH;54DRmk z!6CRq2=2jMg1ZF>?k>S4z+k~0g4-qU`{X9)+;hI?+w-TYy7#J@n(5uuRb6W}7oD*u ze3+w1O~36lyY4dtm!YVf^z=<_){lweDPmQje`lnOe3PicLXKuzP##5|o_(sa&LU%2 zm6;JELpiW<)4($9mc;14a|3mTZh$Gk)b!N(b#>j}hKCZK9G^R4z*9wnq62LTb|lb?rG_#V zlz2zwc;E!KpikqD0Yu^xcjjiiz)gE!%i|0)`Rf=c`#Mn$`XB5ybX7 zEvhXB66r;7z}wN+0!yO46!{9i7N-lH=1$~*n+~jCd$b-qw+s)JFmQhhYyq* z&F-Rjj6}3!M<^xjrl? zA{gv>17m|VbGo6+MnE}8YA8ziU@tYN0NbY^KCY2K9_UX8h97K0lnGDdZRF{H@bi@B zbt4f+PW0?r1kQAh8uEG;xK@{Aa|V=le3c>%1wF#K3JX0Zt7xr~u6ohscGaNk9fjz3 z>{KVl3ob+V85Lh*((NlW>X3*gN#C6w!?Yl>^Gzjk)?HCSG44lQA5COWn+Mn;KO*lD)36J5xE1AC7l zb%C$5gJ7?6IcI62OM`2Re7NI{m|~m|*RW=5!~2hlYN92yw5ZCcf-kcDTC-3Hj?dop z5eH*_8F2EdOV{Om?~Shu6kHa$(1yE56DD>N+KV$-WCf1G(;6L!yIt`)uhb|tbA+?o z4?x>y#416*?aD_pKb8cwZLv8Cc&6wehB5~}B5Y%F5e4@$1N55g>3ZAhxFS9aJ>lh> zmh~p?5$G8+dt_;G>5Rj4;Dq!>4AAY33W8hGsa{}jRD}*HyFX=vP@+3v396-jTHosXo*7hyt+lb~z>~?a1=5oup%U~F zb-UxM95opF*cDF}a6Aa&PiXXTh-u`y!ThnflJ;%ks099E8%Wpi*|@dJ=xXY2&qdyD z`dB(8;|@3ZAzhCBDljQmOz_ynGU^eTT@$xqTI32taT$x+{wOgW-(Ld|_&rHvuNO3r z=R3T(Fn-Mn?2oEBMDb^otXM$~-X)7CO*(jzAzi0(5ZobZ+&|Df@@Q;8f!WGTF5RNN zg&`&xWM%#QwTp3Rd`lg2agSY{#aV_KyusT!^;ov7jQx!{9fF;8$!hIVV15XjUHmZl zUfaF1N{LaSx_}o5+dLs}kKyAbN@*kp)}-_RIzAbaUeIRZC5Im|L&dNm-@1$%Z0WD#)Smk=-x1yQ9$?)YwcWQaLDH7KZ3;|r zsMh{5(l$>2$go>F-Ndap|Go1le&a>lf}DtWd%NvkH@l#HqI2C1>$#o6%f*U4hy2Eq zT+vzbhx&x;I7{t*o3v$;P%2RcGxLa=_1z0ZNg?JbTgb0W6Cw|iaypuKe8+W z>wDKt(mEqobq*}BD_>m_LSQ3g?@c2YdB-3@SuB18-QW9J zF!x}f+x~tAa=(D6ERC~D%V7EPgYzAX8e*BKfJXSw0{Xj7t+w|w3{r(}OD1=pFm(F! zP`ic9OI8^at>^0<+MQ^P(Na_!o=k;lel-!u``7p9Ub zK;Mx{?nd}FkG*pJf>p? zoSTHVUbX4;o}9aC5U9>{F(TH ze)CeZOSx0jk8{0iG6MVL6`__2sZnnm!o@zs$gAxOcWgIF6nd#?PjT$TK~h6%BaUIo zr$k_ljq6%f^sX7Rj}02vGHCoel&Qs z%4gVHw27LeT!500oMw~^MIYqgH5wvgfhYHSl>$%v@n*Qv zP8qos)v`F~v6|Qi6(MAYOjz+^u)nLJb6Y9*#OiLvhq=$#Swt(0*`YwBL7GgsVU5wh z(z$fAjU8#jcx|D6RISlES;RHVhiNB|4qmAC;E};?C4x@69_L48WhIfGsT{8xRjn&9 ztz}`8`yzlQtUeMTl{g$%<8Pzmp*Xm|vZdd`zc^K{A2MoIJF+q+*$xMPF(%kSc!J1-3)m>BF zc7SI2&GWWWtDuLih`&%x4AE#R2SBMTX8H-OuS^wNAS4`&$8T)uiQJQD>26ai-qLyw zvbhO)D6iI|Fl>ib^6Q)KsppvvX-5rQpR3Ae((1^1a)b%0%3{@eYVaGL$c!qF7uUd} z2UvY&LvLz~a4RpFYgKJk!t!IK%tFTtE)SomFpyEc5OCQ@Yt>!nwFcTHssZqLgY2K~ zE6PUguGHtlTDcn_aW&yz;c9Av5D9~bMC1;hv|I~>g@osjW8Y%HZk!+oALsRoK$A0k zl%qs^&&z>NUYcdHqG$7jy(ZRl!2E6GQg zIWll@I24=MaO$B20dcEh7MA7Vc9$0=_iFx|S4QZ@ckcas*740Ju}@R27glLiI~wYA zvmqsB=Aa#=O120r^F#AA6&HP+m^t4!wSo+vw>kW@OH}pva6iy105;I5sZH`U5A~OJ ztK1@%RwAaN1GTZXu=}C*j0yH26PPJ8O1>Q!ufbXaX1`iF9d$!$QKwEMQHTVuK||QJ zmL%2*8J1ka1#LkqC*(HcXR=c{;D>RF;rer1%2fMcI`-9C=AyWF@?>^!Hm7Kl{YVbi zXu++!ZzW@`wPxWjxNr@!vB%FYeYy_2Rp)Kgri_SeK4Ylz{90|?jk>s3)HAF(0{M6> zr43Ui@lG+Tzm3*+TmMuah#`WRQ!hmqeXXjRTvqH|#BQnx&DYq3Xtf7rwu?ChKOdj2 zt-lFM_xdtFgoq1~$~rTr;Xq{Tu*H9cizzU@=OC;5A``v*^YaJ?FTpo@#B!UwOlp)^ zZF8qg&zfj`GQ|8FPvObH*X?=p6peRD23@cqTZsq(Hy*YkA#+JG0Vu#&j9#8b!_*F=j!ukR1Xt85DV8YV>vKgV5&$RO!SP!pD11fQbFN@)>_xa?)l zgOMdejCV!Wuc27vcs_EW%;MMWlx?lMF`MsV_fIxs^(!$%;qa3j@4#EOR5(NNEnw0p zt8O!94z_@56pYcC*oayqHI0nIC^6H%p5vVO*#w>w0k2BiBAua?O$W)`Yab5iU52#7 z*QKfk)ciz2WuaIsQ61}IM7<;H0OL~@Mxri0@&4o3le+}ZM+4w;m=r*pWQ`d+AFjM8 z6IsGIhZGhWq7eS8*P+e`XAeapWU{M87puMiuaD4YQWhV;TRcb^d!RWSm#o`X+ViO= zLt+NzRJD0{#0cAaK02i;sSr!eY-nEu>OSc@aF7eJhj_|iyuYj6U0qX9?0Ipdn+mr? zlo!DHMc<*uG6sdZ(>FfI#9E;%Ec5!(J#D?omRj z3W?$u0SUXT2+w@Q$my%?$+_6^vM>mQ?%dFhhi9h{c>7p0iS5a6O2!&?Fy**9|EZ@g z8W0f2wxP3!$7MwWGHZ~2Zi?HqE8J09WHoM;?YTLry>AT7n*dK&Zj9qtaUL0DA~T8f z0%%x^)!c#;$<%j`z|W<28#9BGAfB5dvxq=TdUO8olOpDQprM->N#r0!b_3wygvfjx zp9CclJ5X*ig8Z_A?C6_~?MW5_6~aB^fUUj7b0r+3r4dj$*ggD(&&^$6VG5ti5z2;X{@#4-?#^8p60Pk9=F%$5_0!#d;V zArf3`4WJ@zM3Flz-lcF409dViThB3idm^JD;Eg|C!K3%a7||nH}gI%JapMzEuoGqSth?{ z^nk9IA;bQbb!#vIb{5c;&~IJOYDFI%MPHy6(S{7w#%`rZ(O4mW3BQ=QH3BKhOWJt# zG^!vQSI;R+^Vv{!Ll>%g9DG|E$Z-q-LX{GbImlXgRVDhJp6_rU-&|~aSQqgEzP=#& zo2bc-^&65h3v($tM2dpIX=YNMm&N`n1d&MIWpcBCmU4UeJfSK)%~r`lj_lxPAs6M0IwN2#)Mx2i6KTt0jn{IiHG98VF{K zyDWz2)7+gxd=)%iT)>@=cRl}NNDs1!I}wt&Q5 zp%3KrIIIu@Qds<4VM6AU8z^vIJNo3K&_9M&X9VM2Lj&phO-Ld`&a5U4jHK%8^oNIJ zhS8(1toIg5{0Ku$(QFuiaeXhd&k7uMML07U?%u|*3Bd2E2X!EkNQ%6gr%-?aaIu+# zcXA4cQ^?mIJjGJs_5>`)e5+N1HH$MJNiVpugnR3&)CRl1ZPHO`2!R--^=z6Ys(95~&GLia^yDYLA5T((nYcLJMfl31W_T2)wM> zO5&2yO`m7axi2SC3JW4&F!yIw>gG>vct96~&c-DT3`-cm4tZ77iTn~{9$|01#i&3+ zH>mY{KWYJkZQEFf*&ACV1pwUQ1bK&kpbIMCPLM%IVqKp^11qDHIC+_E5 zjknT#>hE-(#C!M@lj9v4q*Ch1w2wOFBj;faVVE%tK}X1N*ZbgU&ystu^+Wzt?pW8Z ziO`={Z>WUz_Ty2yc*nbAzwSwmAFntB8}vj8W=8G(Z6n$6+4;c*f;?u3?)fE6GlC6;`&)eaxd}XF6f5 zJ4iw2)wg{RuV8pElL$T!vS^r)mA!+tcM>4fCg0UvzVbkip=VYtX6pPd69+5Z%(_D{ zD(d6^8HawP_&N-b7^tIvARiB~IQj7K<~p7YN78l-;q}?05z5{UN_!DTIz{PD&RwRR zzl2gfs>%fk)vlrR^pJ%BZj|hhJU^4BrXPZ<+{4Y+Cy>0G8Ni^QRLm-enZ01ZN6q`K zMRS<0Sm0U37MaXL^J7w{DAQOrs?$WX2zGN~S+s;sp_{J_^dhEW);t(25?o@;tJ{n* zBXoDFn-yRNA*#Bt=()3Wg)YDc+oMyso*L^4s?b7WRi%F$&?acudlT7u*7ceCllDx_ zL?E*0t2IRc`M2(7J^KQESQfvT2FM7!{)1j{x1Gi-2+Xxo-s?k6cet)G6;hOvS6+>JY*#@I{lu zJAC*Dg?pe|xTp)6oSLCXDSZGIugc!9stcr5pzK zVLGIR)ll)-vXHJt?I1yh9EgL54n z^FBW)MfGz$2+<$AqZCb$-*zDORie$iBxQa!hDDo2;r>nEE7#0G8EPU? zb%?6f8rTe3?N8A-_3y5fqv}vK;(G9{IyFi;O{41UKG52JaMD2C$JZknsYf_wWER(? zidR*`hNELj;aMlRHXoU{_9g}l?A4NsD*w~5< zZQt044QYl9axe_)@5vkmzHZ8cQ4^c5QJgy*&FfDRKFkEsL*w+~DD00V!6e{Y8CKOd zZJ$;?weCIbKW*K{a|5>=Y^1+lFx7P)%xjR6M>if&sl3Rd`o7AG>Xqb+c5;(-z~J!? zzR3$;HoAB8$F_DBW#!|!z>`&`7Jq{i&E2FrgGC??0tx>?$1|%Yp#i{iSEF3u#!Lx5pOFf*>C&XV>(x~mCsP!(oy^DY zQAu&9eRIPUw>6aa6_p$C8t5;5+i6R+=^}P>`o0mEj6}SbN1j;z&4Xi zAPWspWdtvfpmf@6nCu7A7x}>nq33bJbT3bnFNxEyaRT4h_xN1PzIt)Ow5H>L9><4M z4f6~V26>cXR?uE?oc}40EMKd&5ta59SeeI#cM>-1ay11vex7C+*hkNu*bZTcC|k6) zBPD@npCXi|`vg!3_CqhcJpT$eM8Ivu3B1JK)aYQBp4T{9*|tip^5Rg=ae0lWSJm&? zU#}9#bdd&Aain>vG{@~1$S4U=uTe06;(z%C-B>2U2?>vVYqWU=wiq|w$kHwcZz1rq zS*8QW>-FQdz>_DiY>AXM`s%_XnM%JVlg%l=fAe`ERNNT!!?_wkt+u2Yp2b-K4S+am z7co(qWIJ%?Dm+;$WoaU;)m%%HX;RidMw98-B=G!Xz1b)tET7(_V$;#&{fTu0f`5#Y zvRl4|>Fs!@Y1yWWT#J0%=Yd+Nr_cEMbNT-r0!^-trP8@**~YpGQ-+)of&>_h!VywV zQWDptXB_Ue?9|8b5@AX6LelWC^XuZd?#&JKhvKLLO|_SmYijf5Z}_G7b2ibr_X2gLc75;Ns(Z_iZ@Y)PT}<(mD$iZuF32Ui;#VP6y7pv3AizkW|DwlK4ji}suthz;j5R>VGgf>FQ?Nq zde^td2hd-0Y=OeTWU&!909jGLc5y@WMi`k!)lr;wy9WV-!kP$mBnGm-<>-Fd+7yFN z!&lMT3CS1zF18z?;56?RuQxHs3kK5PYE`J2yM4r>r5>Xq;53=fkyI_JQ4DTJz7or$a`&YL>!-9=vZaDo+*qIqUM_zl z+5K@Z54mkJ9)EFdcAV566vU$as1)(ByFxTU>~;d^?6L*LN@N#7)i;kTi3u0%;_1)hratg|Ynr}i)G8pDk zsp|)>u9GB_Vr2)SCGtnG!_AdEzU=QgK-Y)pb%_izi6dSEqRJy~B^zdkYDPp?6yn032$Dw0j>3W>B^2OTEIY|py0wCJJFhRVD0vE4$f>0HE$ zs$0G&?%X4IWMZxc0Nzs_+j#L@yGbp-qA||R-W}ktcNLK-)It^Z$?)Ez=UedtLjmef zn2+S{@AmHWfA)90bTA_QGv7E6>gOyn1SIB*=gx=wXHAIbPXEJxDMb9;>yK0ZL!bIP zFZ-PQcPWU!*8SV-za*@`^B?{J<+n7%zoYyVPxx((&&j{H-z-#SHk{Zp1&@&zjF@%t`HIV-x-L1q5Nv~ zpG!hN-_!YR1VVqlwexqsKZEYi1*6|KBK?=;qrW@;89jc+$?2i@pr?tcKxR|RJP diff --git a/doc/Conversions.pdf b/doc/Conversions.pdf index 3ed26e12f99dc9cde4f31bbe9916a6eb3ae92375..0361c69f5f609bb3fcb2422aa77c955eb25d7368 100644 GIT binary patch literal 152289 zcma&MV~}XgvaZ{;HM7%_6> z^JXQff`}L`BON;w>2S$#&v4stJ`@uH1A)Df6%-E-y^N`yxr+q>^IwY+y_ltqi>VX6 zn2n)}sfekuy@@FwAC$9;lc}LClt)gjmUKKZJ6zwVI!Z%3j+KZ~Jdy#1!$+b`08W!7 zLHHOR88@$I0ka?%tjY7euoUUKG%06p3*dGs-4in96LD#iRpE#4+ui%q@8j{eA8*^= z^>W?%*sB$4hU*yiS}tXmEG@aAXQ!5Lx8}3uqu)_K>3_0rqtox*$J)18#E$@8de^6Yzz{WlY(Jh0nFJ=+v+}Xwe>G?V32MuSpa%YY;6pvJoj^Ijm+~8ts6kaa%{R8pB#K zL6-+$sUvq9(73FkS&d+=nW6r3luQHA9(u!m|L4`qy>l^K_#d7GkbaKp&+yzv+jR~< z^;~;AK9>8sfhsKi76^(S z57}i5eN6``b=cC|O^)@g)I!8UWk06sWd?e9h>`oObGK7&IRg)|y!(rfK4$&xhuL7@ z*<;>)-=Mhr%fWEPM7}7rwZj25^ZIskdzb63(VN0}=3wN{8yqvYAn5*_cWJY+pIc8m z-wtV?nYX8%I)~i-NGV+dOtJfZZ@(kRJim{Z-!GT1?JSbXxh3|omNdW7)cDR&MLOi$ zXD`F#Y%Rm6iIPe{tXSR*J8;4phR41Z!RRYLTiiKshrs=&dDSL`92O)DAQfQpKM#B$ zG}{Qks&br1XF_w@kdHG!l(pn~w}95s(p`@kX2*LOQMhp-)B zmFcDrjvfyl=QRQ|VTIaU>I=;}=?a^W69MY}N3uFBZG!_cvq=#&kJUoE zzXr_X6p~mcNV12-2tY4w@pbn4Qyzb>-=|~Hgwj1g@jB@PBe|9Q&w9cbRE(cve~OP&HIN#%@4iKIHsw2~vq@0#BWKrf98&5}Aak5VJ2 z)6tVO6h4Mj1*AfAMNEPrV!$xmOXA4W7#a6i!%3HM%VwCEhQGxq;+NUWXlbEmph)(a z#1Qs`E=VCXot7*dfI|q~JHjX@sU~T0-w)Hw*)K+ixD(nqtNXb2eeki)tyQhnFNbD< z=R2!OARTP zly3}G57MQ84$Pp_n{DDpIM)ChB*nSZRM5HFYn+nqdh|;f3(ArkBtYv1@HN?EuY|K4 zSJVNTbQl37Y&8@|LzSc5@oKnkn5M2O1&~Lyowtf0xe6VYGUo_rq0e1FDWp-GPBby- z8pg3k71^?jt(~OsORqHg$sZBiHIG+J(N!kFr_9~~#&TDhkhiEEXGv?uSlg~uoE6!Q z!PXcyeJc3JMLYwIJ z53>3YRb*zL1piJz%Av+?rr_t0kGEAfWOK-K8F8W{s7av7$!`;KIaesm+G`3y_)P~m z6FF8^zDuODS!mWysj;A80SoOEj2;lJY|08_)+ww@x^~9u^|jZ(>zPXua8jA8(`L97 zPC0KkjP}p;Y2k!o!1odXsuVy;#?RGY#=Jq1U!o5s21oH=%Js|{+Fz}KBT!Ea^#O9e zsfDYqG#lYR7Z-Ust0%Z(=R9Ib65q8_Pf3Hbcz(ZG(6)YWqDC~sffJ^NFo$x@6(apg z#&#TGy`djXqWYTxUz8AY@=qI1HkB1xmN&7Cy!(74NSeWMAdBz@j)O+(W9Sk*gt zY(pw3A;zf=jM8ps?l8Bw7`hY=EtVmi9n5|$yQH0dc8_CULPk(%^XfB%0s)#cgOdto z7ET|kJCY5CCetz9u8DKn1B{w0-2Xg>!ODw5RD&;+Noxi3rm1r$C#YRr5LN@KUq}NG zf4-uya8bQD=?pG*CUIS=O851$#WrWtPNX^Dy)>4to!D+gqkv9eD(5M-ZwXPnKoGK{ z0j>nCq30iCi}K+y_U9k;32xW7) zKzLj&Zid*g#8?ZH2U)RpwWZXY)LOfC)g=^tWFUH)3~@bqVl0(85Es>sZEC%9b}5Xv zsW2|OvB-xeLtzSsGY`FeGGwK>-n3V7&K2rgU0?P3^8y~2&tl`I@1bS(<=i(T}68NapjyXL#A|EYH8_y2zQI1Z=B zfBSUj&--z@+&OgULb3Yu@if1CX^XCeFT@VBFr3lV9>3d-?G~`RUGFUpx4>NxV4kiM zFsM7w$&7%rJ4yN!fBYb>`SVx#T3#pY1|@l>5Rs z)R|gJ1%^`Hv~4)dFrmUiQvfs)2la}U(;AYr4E^IX>YAoTfmF3Y$YfSVvlwKVz{BNc&1dv6G=ITLKoCS&+~$OCXICoDZW^_#~rINolwn`tl3`qTrHv6XaJELM(Wg~R7o|1LWWp6HVs*@VdgMb@7Yk!qgvFXKCN3-!Pu;(!=p1s)sN5XKgvI+;Sjvdt0lfgm z!d;EPBp9i;RP&n4Q0*!}WBTM0JZK-aSO`_qg1dV#iG;VM>UIolSl%Zk{(5D!x{`-K zhf=6$Q=lF~{(4os-AT~cwDp94KFgpnD1vzE?5D34wx}s9S5af=WJcp|#Ai2(M4TtB zTfj5c3s+4_63UbBe;Ke~fzDVjiZRLI=|txspM~1QfMF2+mfiH~M_6_+6>fkMI+7l} zssC6KKy&d6UTLO3eRIi&>`7jA{&nI@V{@T2impqu({n6FQ$O~OtWGe{lCKO;zb6R2 zSOmpWN~Ib?=jII02|z2Ub_@ua5;Xh3)2p9FL+!K~XE_(U&cYHvYHyOS_<1NjbqnbP za)vVbjK)s7&crIy&BYxR0|q+OfP2+3KC7HoGSuQ@^V%caD!a&nydHW}g+tFn)GfS3 zee2KX(-*B^2->-`dIQdm?$8MgP8f0*d66#9y$-*7ANr{O({s$UCHxi%9q04z{^qRe zXuYkt>f3V-OAl~W05nY_?0jId7d8!J0~mIxF^-1RQX(e9mcoRVF~HF4i}`UYSSb_* zQd+dnMz%haURXf{;k7Ql>-HIG&5ENQ^6Egc4bhZBs`9ZkFxA%#p{~12aP{g4#gvbI9!B$00I%&Eu5;Rnx&X#=cC}5-&XLhE?pg&= zbWgiF32)QT1URZHLIL^r?^hL#MIU)id8((G`(M>jb*VbOqBnk!W|{qhWAOYBss7uc z8O!b%<)Dk@x)T>)92s<)gi(TfMLZExfs!H=7e544;Ao06l4#xTMIQqsQHn6He=TH) zi(3fKfs!C3t>=O&a5O~>U9E&?z{wNvPp1LkikuA*Jmp7H<$pH}QAo%A%Rq7XuN@=p znxTt621tN>h^fHQ5S)DK>)G%!L>T#hpC<}(tZX#{PNq1}>U<8I43Vc~%-0YxM)6t9 zE$i9VEGf1x$~5VmYLY= ztsR zZ2au*-R1Z{K7L>C#hd+@?EBaj1)x`0>)mNV)?CrH=Z&7ft)CCu&$iF#>!n)ay@58~`w!aCrpZm-E*+0W$ueHy!5E@47{^lT9-NmgEvcl*6VGJe!AM+WB zU$oD`m^y?Rz%dpD<;6LM@ZcN{Q2(@jKOerH{V{x2i;GwCxeT3l zgU5dzitI_!540?y5xbKJ?LH7N;NR%sc=D?;!C^$JkEnkHX=-yRu+Uw`I2{3K?p=$I zDAZwcOG)w^NRDuV7#VZN949VO(nxYpM?jyVNeYe*6?wz_h+2%JQ|eJ9Xfm0)bSzo> zk-|yvuD5s%!kBwFo5g$*-`ug(+i#*i^b@I^5=G&@*E?ig9c*3*? z%#DcLWMfj0E+{up%OI3X#{g5Q1P&}xGsxuHN98MUdz|5LO!2R1@a0%<{e|;_V89Y+ z{9Yk$ZlQ3{!KhbI2ZmBi0b_ov1)u|mqO5}EL|G3Ig=lF6BtbdP~S2IJ~M!DHkX$sXFwgGVQAha@0&sI<)m32KXRiVTZW)R<31p`Sp} zr>7XzVyzJMU%`hkbm@>15QRF|Bx;ms?G4IND?}4YfQ|qi+uE@88jjLV8Q-U(o%+Gva##^9@t!VLo*MczZoVszb6Hh`ko3#U9W=;B8E_y3&0;tnzq!5bV_ z$tWatUxZ9a91cS;k#lUxN+||iljJJ;yAMpBwr7HjvuCBY^@=UEcP6?g(OsN!^y=<{RSSSRvIKJbY>XPP zUMEor-rCoNx~eOwg`BOA+CmuU*gu5A;-U|Bdp~yx3Ea^@*?X>0eVZnrKFP3o$z9$qIgKS?DUn z%lVk6psNsHPp@a7vlCAMbTMathn62+&p~D;J=$2a&{c?T(|ohgS%{!I|BMogUxMHM zo<)HbYKhQgf{Y*8{=1J_(*S}tH$!H=3-;9z(adYjmPQ>y-loiam#ow$OU_GgOJvVu z`wRX>Wv}jk2rvJR8UKVAMpkC#|AZG7mj6fW{#UA=g@xsRrD~<)vDsn%ChK7qwBeBx zyl~%Y|(dx9=Vl;ODsL^V#@*v3+adUM|=Be*e0={O+c| zAAelUzWh`!|MhunSyr~5zV9|3p6mL(;93945OR0u`*szCYw-5qxB@P)uvJ~$Re|i` zr$mmL5)Msd6)IIMX#F(}wSd+83qIfNJbZV%B{tl>-{;Q*Y}Ms_`8mA&yg&Umpd)u- zd)u?v+b=)Y+D#Bxa%OX-tt;#(V6+!W{m4dcLb|mlMDtJ<9PS-GIji((= zTup@DaN8jpS&Xo~eMoPd#o-dLDCjm!ir#fUo&Mrc!=LBjYuF=QS)L6VDNUZr>`3*1 zKt1iz-&q==ye4=irL;L3OkfZxM1e89fY^Dy*DH}F_DmlNavejifCew>_G-ef` zeh>|a;6v6d!zlT_qU;LS5qd(r#NYewc3qoOIyYI$JTIHgj)@ z8Fg-i!2#)Po*^8cwWJ8c7LH~OD&&3EWRQ^NU_r{o{qA|xS!>M_P^q=_V|+~hh{bop z5D`aQhMF~slA<|p+A4b@RFyZu2Ec%vP!^REMTO)`;uf;PZo{fcn=bN`4OVs9)Tp#0 z4;}<1z=FG)k!36=UDF?S*o3p%4X(&HQ*=47nir=JeQwDC_Q6P=SdhX|=KhIoa%y=jD(nCIC%uEpVUO2p9Tt-_O zYe*tH*oKnZ2yqA#A&3O-f|H=r$LdPghUCT2JIM~P!|BjEtcsBLHW#OOskxH`{=0`I zq!tzh9Jxe%?ISkv9CL1Qr!xK!3sozuO|)l`=V8VQV(*I+&D$K9CT6A7ISE7`>4+u> z+bCKWM77FO;_~@ut24pcq@XqhWhL5FoYAzvtyVITHVuVn8r`IghZ5+QRC7SXC{U2Z zX98fow6HnG1Tjo6AzUt_P*G%FCREFSMj!pPDUqmwMsyh>rWE23^~WVA7>tJr zMsHBHjanxeb|<~a&wh!pRNT0iD-pOU$2*JUX=@1tLIX5_5IP}`)YYa&O$|ulo?*2B z>&c$JTMSrEL|QaYo&j_^;fbc6ZPs8&*tXE%ORSyD*l4Cmq7fP-PXN5n=ag_d?|(=x zfB~!3#76tKr}W5;#**}nxLBU1r`O9E`v*WC7i@vr>CvEwrm5}5`SudQRa%q{+R0(; zA!=HQl4iuY!X{zS=ASnFlfCf~ume(GXB*&0i;p!cwk7qu{pBK9n7H(5FEUBdkZW zqa*o15>DApP`_d6K?S>CKbs2Sa2d}q5jVYP=^1gVG@TI?i6R{@QOJR|;9u8qL}TZ7 z{H|Ws6wA0?t@I6oZAA=6;UV5!EIEVy*uyg4#5OMrj-ZsLi>`D>C$6?{B_ZSY8UK2h zrhj?p3cf@37ai4n%8FMW;CEAlZ->tB##jEPN8sdA{ia=PQXqAzgy}|_g;ph6TCa&X z3#CF7xS^;Mc@~PD@WSuTLN78clroX&!SDaqnilKav{05a{3V7siL2=WgMh|d z%B}&tHtd4%g7B72+OCZ<3#F4v0H(mdB;Cig{0?>U{_xRaaNbG^LyJtKc1PcLIrFJWTQEL#c9pBB}y<5Hs zG=V0AuC~r4p11IowCJ*aDS#Iv4NgpyQGC}mv@0}Zd`BLD0X^8Ok-D7u zvYUiSEWlN(MZ!{sjuI{&N1_-TGd55hU5w2a+WPr9-K()UrY`EkhEDRtJe&&b1I82pCdsHR zyLDt?Ov$@^Vl|~}<*qzVm?~Cn(Xd2PrJI%!oPfo!3XhR5Rxi6U0wR!|6->y%PB)b% zc!pVV{TqAba_8FGHB(#Zh^CBm-D`KX#L)*Bh$aW*9b(cDeMu{bf@a7?t4d4i40$r* z7@-=KrV>D5G#iOnawZ~tB}~P1OCZs@FBI4Vi`6{15};2t8S_Jtpxam_2}1*NCqzk1 zvb)k^KYpuka1}<<++7?5@gHIE^kEGw36|&AVXgh+8qCk>G zF12j3HAL+fNyvy=53r*Q)x3jLP|P|-Nt*gZtvt|I?vD*T9$&ZS6DB4A%!yJ1&f-x>@hLR6x ztz?0(+n)DyuL6s0vM69pJ|k(Avym2`{a#To1j6SdPkShh!~-EiIY&dDj6Msg zEQ^{;V`^jug47NZ#7nKin{YWC3TQ#nB5H^8bwCNIgc0S^?npXPCph`VIMeDX_?D?e zr1HCf4#7_d;gi7Td_u&s&xADfH1RdccwWg{iO$x09oM_=w@YQ6=$qAWBigkm7to8` zMF7WBWxRAhH1!>0>dKUp$L5HP>`=SEZMBvxyNxc*G(yXv6i~S+Lq;(f{~!`cHyR=m$18LJ+9E-1)?90v1b5S*BY4J7kvTIk8s zK-2)kd7y_)tDO0$R{nE9wXd|!J@Mknxc{w-jFVjJg~?`sjgc#ZAq2ZwdP(%r{_sW4bE?noI8E+@T87P^ z_~=c>Aw#C=Jl+xx`@X?p9aIiPvotCMCMzy|7!o%up}O4~KB%i7=!xn$fjyeP0X zWc8d4j9NPCKhCA!OWxp@6`0zNeP7Wq7PwG+$*^VmJ%o8QUoXN8XnF+CN4mhX>A8oA zYbu1L=Sn^0sWK1Q^3q6WRO>?7f{`ErBVu}*-_Pp~#&tj4j1@Y_a z|2E0KeVG?}7L%0ZM#^5QT5M84Chmh6ZBjrnQuaPr{%sTcUjAt)JN{`P3&*AN(_)Jd z=3UV(TWnH72IPkas~4ISQI-%suQV<8D9CMYepma%Ue`oqTaAk+HngxUiD?3Gd^(ac z)|0DVPaAJXkRfk%%_2KrEiXUI^H+%ZmoB`lt*azS-lZm2-SpO93sYK?EaD zdb4xQf-l=!I|#5-jX+tj%j7Hxh9jf&Uak*16M_{&6EJ>xzPcLFCV8~1;+vEFK>?E< z0Ite>bpqM~=ow{0AW@z$BZjFgfBLWsp(_tS zu4_;S?cB(WFZ#fC4L36Ly?E9p42XWNLjHW&F~xA=i2H&=cZ@EZa%O>1LRgKnM{dn#rNL3RxJPTvrinrEZ7*4U zH3YH1CXOK_PM5A@aL92Rc3N`Nr12?b*^|%mN%~F2h6axS1Itjdw{u95nfh82+!;;- z(3qErB^%e5*j_qV*?8Jl4Rf->!pd<(=gLc_W{)OOb%D+K<5ShBDxgBj&tipbm3YL9 z_$1_9LKs~h4^?6>$a#Q!wX6%Eo?TeZgUw><7?J;(8C4S){oplh0&-r%_VZQdSu}g? zX7%^<@;7$S)w!8_|K|6f@WpKOG=Xt+jk;I)1BQ#?ZWiWm#e^fNLNA&P%ke4jO%A3P z@j)^cd7jF6ruzO#FwZ1gwp=+Fw#j4qmaI7PCfPp@jE4KkQqtiLm-hml%8JFO3h-|V zFI%i$aIX&WqXe(c^M!bKo62@eo9nlEEpF^r^ygm$J^zFI{oAMh@iTVL|EkttXa4Vb zt-s#+|KWZAw@8(dfQgNbf#v^Ql6u?Y>7%mx!QhwYeSfo^>q|B~vtvSLqiKjlVAB~w z5+aI0U;vgPLjV~m#6$wP6A4vO01C>!qZGZS)#th(QQ3+`y)~-UXrx`e)?#Gq?=1oC(l+|Mva;$CE#Qe;}9hoO6CN@44nYCp)jMmUcwK3sQOnHai=sJkR5R zJtRRN5vUDz+be`~I;WX|R|4WWdu?QFHr&r+5>u$dPl)9kn_YL4>nE8W9nr{!*d%db zZE2;)Wh!+vq^1vZJ7X;@V7ru>H3NUZr^D8H9+lBulkiO5I6E|(i=Cy{XIx!3gyliQ zZ~m-|8VPmh73K_oxMyLprSo(eT;FEwYaWu(g`BI~J8N>5ID}L z8p80680I1Wi_u7l_8c=!xsp{Ych7(&leTBo%$-BmE}ngyeGVT2s?)R3;mG*9@n5Ip(*SnDcz~irEvb zAH7K}iMJVK`Kvh1e*|2Je?~NQrO^_xCwQ7DtH+uj5UR&ttI6RBW%Uahl3WVQ;(B8^ z#~6me8JxK{Bjk|}b~3j&Jb%K3evaY0qcRMTvgKXSsZ6ILM1MzRayf;;BJ*mpGNpvY z(%^lNZ#O`pc;@qX$UkUqiw_{o-C&HIhmzu3AtrmA^RbY;QTCa~_sjb%QH1c%W zT#8Dg(Q9e67qpdm`K|IaI^E@LHk+xxO`wRIe5ua@1(<0bFiZ4L1^cGS2FYDC>M= zF&>h!qgyK|P7^M&ZHYr;KyCL$Jc>d;<)Y?9l^uq&tCZ@DZuiMCRsn5q&IBBvTbt?-Y z=!aUkli8Jg#t_9zwBJ4xry(3t|Pl8?P|lRK}|y6MwU$a~3$v%Z~0{4AA9$_PbW zK(W@w4jqZ=aiW9n%05MXE|`iLqbO z2z!YYskBvv4kWAh(drb!Nt@6#wx0+Qaj^I_$i6b7l9>#6Ld6l4PO6Im2!~{L9DMf%;dk(mep%zPw1lVy* z&@pP<*mB&+kU=ClO2p+2oS_z|n)IQIbBaVsvMbdhwUtP*v61(4|Q>fX|z=~K&--=QyO9<7;2PsUw%7IlTonRU$x`C_S zj$ex;6F3cRgy^D56Ca`W@IQ?`N{lL0-tX{H2}T!{jh`yg6C6nB<)0pAIb)L?-+-~R z;xj#&i;ZT@vt{>jn=3K!KHEkIh`<6s3>X1@03*Nwo6?WXrqGo%4M`E=A9R*F?v<-* zhOL64p{z)QKgv?%f*&uPGM=073VB;Vgx4(-D(TCHV6j@s(|6pTQ_S+bZ4TRaPa=X9 zR~vEed%Yb$CN-I!PXljw@0a!NyAI9!&KMa%_L5@q9m*7i?m-h%l zSw=WxcS@^=9ca;_SVc;hF(Sj(Ah6ZOtVMdVDm7KyV_qV}2*fa0h4T=O#0G9Oq|SP! zDj`r(eLkto?L7NcRP*r+y9U^FfZZ?f9hEd!)bwwTt+J>7Da5ofC>cB}IogOo@PjO=y^^xNq*pEV`7odaC!Fm_ZLPON?zS8MCUVx;x8e2&_39F$e zAb}c;$@oFk#XdL^4kOjUy2=BwkSoN72M8D8Qil7!rw|- zMik@bumCa}1eHMkwg6Vt(#8Z$qZHlfX*!!KcbrbEdokZFHRiX>QH-&POsX|-Nq%blxXW5Fl(i(2f__x1zDR32yI|TRyVkDp^8>Nm7*;uiPU$^YEuT3_0 zeXBLSE$?v{g8tUyxCzbGyLc38Mo*xW?nU?&Gz^`CPBo`cvghL1i(b|1z*J4v#4zj) zi0KvK^yD`+<47-JX^eTqZno?D#LX2vh+Q@qZCtz~b^3-I+ikq{I zl|^7}R!$rc&vORpeIELhZ`bh}$cbII?YbMrDQwU8wbP?;t=oN{*K9amhl_pY!_;vJ zUtREhnbhUGzFM2DuEJyd8Ylf3hbrOE-DBbGvvhoTRP3s?u;U@gV)h8u8nFd z%sAve7a$f{AO|2LL7kZu)RWg1wURR-D&?lT*#y3}ipCAu0k+oExe%#hQZ!nd50=F& zr;10><9p#&n{;x|^#vdL^RCl&u;?t+lNk@p>G*EUcNM#=iC)Kj_<_!Tv5W4ZrrQf| z8rPz$#N@h~kaD1M&6Ok=FH`<{ajhrtnp5#?StpiwTm;8t$wZm%+6}yjF+bZJmIHrn zl^YW&nUD{&C|NKAMqVatY_h?Isibv_{ehCAMgz~W_=AF;I?zbWP~ALBSN9HJy2tUQ z->P3-i^cR2mA{vL&1rJw{&wF(fAZw1?zEat%gaF46r!d5?roc|r}6h<_0(7ADz;Vq zCc2NSvt&z`k>%XV(MNTq9u0xW?dXS0Ao(a_wIZ*b4qYZkV+FA+hGB#{BjmJ@j~=&G^pk&pVnU> z1xPM|fZXE!Wfd8~Mrt0bDQ2}IV|qPBt4$ZMz^cUyEy-xN*5ZlX%JQz*Vw-iYOvHl@ zx^bG;-&>%O+oX_}xk#}@V4kSYq6t>%_GoN0tM(&WuL`eAS=-f0UtU(WWZ5fQwbgB< zIvm?BS>0|A&W%lF?bPG_%}m~P2Yw3^*v`Mk85%J|cuF4q*)9-+XO6#{jD zcR~!VNr$G%ip7AHOV^6Zi%)H=rl~nL_*`ZY({2&tWz16M&elb60kjCJ-4xSBgOC_; z1E_RtRh>~~QMC}lj(emn{Gpu?Ec$@1L$m>s{0{O+Pd2Fu94&I#QK)?kncvLXL)ib68?@3?@I2Dhgkj~jmV~VH*Ohmjy z=-Lc6Rb6NV(=n_DE=5^0c4*1tcy+x^<N=TF(<3mJ+ zz@>NxybU7Ebu=86=K%Ng3L%`(9T2K)Xs@NpP}?{^cP>v!=e+>8(P zMfrYO{_QXYPyV%VA0CVX9F1)kP9~d!+mSPkpE`>s%i$_ zFiP-i0OrGR0iOJO;XGWApX7_+x8MWteK^VN6N-Hdmfg)2mpZh*7oNFUdW_ap&A@PO zniO}Kt8q;;zDcS8`l&oT|JOt=x~eSY6m>1l=T)^ji5>kmgQ?K!q~K?@IyZ9oT|NJ& zC*9Uo%AXU}c0-)s4H*iUFI=owWJKa_5Dio-HjD>Tk&0m35Gf-n8dt9$r%y8B9L;bEgFhG4#6O>0~Q5W<@RZ$nzL=CAP zPz2RMg;5)eX8#S8C%B&^*)JqGhyLPFk_*(Wu0*b{Iv7A~WMSQgpgUetdOu#~;&e<;`DkCH*TBGc$@-3+vc>nv?Rz*7XO~5d zIBDBvPMn*kjNtYHWMe`j1g~I$AcaPL2pM@J2xBwmxkon$ z@@YSuR_+c|F14&`T`wGv)xyO#CQME_LlV8+=C3C!_Pfrr4}01LBD+5G1J(Xs&ac+e zh8G_F%N#dn{`08bQ6(oW-_k$778_pnkAqkEHA9@g5Y8>iopsI*U`DP_Ir$J;o) z=Md9jDvZr>@sTpv+jeMg--jz@bFaV)yTpGhLH)YhX(C%A&8^i1_WunuklTG7Q+`p6 z?-_ltdhW*)__0v+?!_@)dg0w6p_3Dfmmz&B1V4imi`m*UJ;;?du7U0)>)hO1L3qVa zIfp!y{~%C&lVFx%uN(GAwCShBH&thVySt8n(x0Nsbvl7%`Fnq_tJ25o#=Xyf zye#U0@~rIrrBPCDeT(x9qvS6zHQrs}}-s-lL-uPQP6ZCwcLm$;erq!cyg~!)VfVO7HXxJSfnNr;3&ff*+l(FFW(4 zqr>2f_+dDBY4*YD{~_!jfGi81eNlL(d)l^b+wPvWt!eJIZFAbTZQHhO+qS-*|2^lP z`@Og?-i}z2Sy`32a_wD}vDRLdzjP1serlcc1T**D+4<@2xX(-6YwK9 z8gev#CA{*GV@<&BSj~3QZM0RQBIc+-NGphnimG-<8^h}^hiLr0PRRKWT+$XTPn6=^ z*2~@%p698RQAmG5($kHxa~HeUb5*CE5yT(&tA{?i%h;m?DjK~w@+GTSNvDu8VAM$? zd-r=QPwin#`)m-qXDLBuBfA$*%&lAWq8)X=%yeOB0c&tEa7qawdUU^^sZqiF;}WVt zA`kY7c9G#CBPTx09U!D!xh37~1xaMh?%T+2Y!x4TIt+FNqliBOy zgT-=8CjlpLL_g9K%?pX&mPuy%`Ce829__2AT_MZ$Y*OFy0q#`U@^Rn zbjoLKh|@~r)Nw&P*(1>j-LgMEMZL6m?zFk%0F=kN51YpKp zRKq>K=@!AIddgk-tMhJq(C_=t@g6_*c=8_S2ruxG-}Q*&rCPf%tpAYBe8J!JMfb1OIIDh0{eD&UaEQqCwL6VBv&Y;oHb4rr01ZEJJ z-^^UBqy%*pSIA&*l@tm0b$8;s!xo9H*Djij~*{a(_iZ?PggM$NB zQSk41Mb-H|O;XiG>tmC5;;B2EPWwxOud()q`-L=@d*ep6`B1)e8r|A*JIBnV*QV`N z|A_1ZFWZl$3pf4Qes@khp2zzY)wjp3+l{M>&9TJGmYr7Xi;i0}_07e-^f+`KX;QYZ zF|yU$JNX4L^@bIx`TT5~+zq29$03Px-KJnQ#BJd4NSI%O1o;ADeVDBP276#`XA&3VyWR?pSB_PtG#TJLxRvsZ9B|su{%GonQ zI;w@3Y45imN4RWCDALPpPrhxB>z&qHiPDlqW(ddg65|iXi=h}gy-Ald4b0QH&!yDY7 zU{q0wtHEfn&P~GDlVLuI6xN`r3Zo1&Vn)iGEo)myvB!xf%892&+Smm(Xkq)fh%5@m z^}=Su!NJq&+UN6K+2d5OY<}G=Rng%>(-#}{*FBQj51 z+PRzHb&s?>~>2zhCoL)|yFyez14xSeRAry~FY$ zJtn=BeN232eD-}JeJXy=d1XMu5y^o*5M9@Qh3n|_5J-t|{grb})*l0*{JM$pEqZTp zyscti*{u{h>x1_$!7CU%t4^UVG?6kKud(M$8rW5|2hAYB1UO7Wxt;S{Dhc?WBUqhK zib04in!+o)f(}0(dzwaNe#mKfUTDrf%)+q>wJ^^^MCrWUkDTcZke*1A(@|2|^$E|) z8_OfWJ#}Af<`QPzV_ZL<#p5Q08m_j;qrzrWvx^m}2{B_jFw&4#;C^tzFw~_hXF>c3 zfuhX2HvsDbLDTh`2Jxglb`&$fT3$6mLPfuaY(nk$Q<6zf4~JXXKTA7JftQCjG*iS8Ea>*S_@_*^5Mq$XD zuM4mN3^uG(szhpv1+EtJG^}@flljoix8!>MQE4Kn_4pRb=sc-+oprzgE-#@sGNE@zDmXhSJO zL0Rklw^JR@V@(DR=Md|z_o+B_JmVct5)ZhPU6(O@CHovHBUSw!B0&Hcw}jE|>h^(R zV+0}e30!LK@at<_IB{G=?!VmdxJEG39(ZuJxVgw0 zqkUeuZm#ey=(~E+!EvV8AeqCx$R<=ruT%i7lyZ6xCCj3}36E(6%%dBn`@TDHgnd^V z6Te;=!dsXq+(&di6b)ltUo3dvoFdEPIuvN$NKR{QuRA@gte?<%e$oMek&Kz1d7R2- zEW!uVji6?zqiPKP$o|j(uIBvS|IV8ys#yedZTBM*WE<73yx=74R+%V233> z&R0br=|<0|Y+A?_HNwxq`n7kJ^v+M~_gx%MU8IVbRxGH4h|xRrmnHI4;w*Jw&xd^{ zvB^h%O2W1$0Z$!u3nABri`;|b1TkCwXG(Ab{tKxR})#(@Y`DSf#8)FS~#pxhYI(oiu z`SD;KL#kZN6_s6aoxK&+*lUb`yipdyiR=U}*o|@=f`E1<_;6yE^JFY+X$F}pA!R}( zMVgWHkXteRR}Wtg9a>1|djfTze^pk9X_?lJY4f#m68~P(R>@;+YlryhI@(D)rS$Q# zgx5~td3)e&m5GMPDt*P3+jiueSJfS-qh-7Cz@|Nd`+0y@08q%f4{*@g)Oph6-Uc}< zWkWA=c;4h1WnhLJ}B*C?8vzVPe$t!k+Yu|JOfn+-L2-O$IsVKJl;5))^<`r}x zYfBK+iJ0(7G<8E`qshv zBovcW3>U?Zj*DESsUOhz>yt-!pe8>U89Xa&d0c*)>1-#dO1UDnoLdc@(M!6WI7aN8 zjd>n~>a^l6Wn(RMgZe#7PUkF@E#9Q}$=tJg0><_0PWYj2k|oBBh7LoZK<-w2-*+6| zBg4j^XNup6VaBK6HWP+%ZYV)b1xRDbPIP(2cOWp2j6)}_l}syR6F)Wmq87X(j%Ga^ zswfKJ>zoV=g+fPVhBG)VTX}j9D~*FXUw3D9Vcg%Uf8M(BW-yj5I;(U=whi2Xj;nt> z7$yDuThHd`EbE9g+TfFF6)cni`29u4CVTzj8Ntw{gL*KS90}O?e!1331E+D9%?dYo z)N|x|oyP6s%Y8iM-{)#W59f3!zzkP)L%F0K#j0yX}CRp6vow7y81j3wnni z19rm=f5$)UU!%AcD;+mjFOFWP%3td-GOrHTp&|q4KHY{GKlV1K;F}eC_F~p`AMOC3 zs=JW#bo6GX-Ru$I;c+q2&J%?pJl$3+SftMv|Ea@L5Lm@hJV|YSy(h#z@y_#-1 zXQ$w9ZF$?)N-y*doX3D(&Yi8}YlT|Il+DS1)@R1dSxRW}p~7wv=&!PD8i-3(uc6m~ zVpc)F2}w&;TwyZ^>0Q%HLDg;%2vBjEhg>7q@Wi}mQeoE%Ja=LQUr{%EE1^T*!x3Z>=bk|nH-BvT7cs>{RFD~fAbWw0KEwoTGXsCPS=r3#Bm44Ta-UV= z(*wt@ufzdv@~zRp%Tt5Jyxj<0e6>eqZy}KH`_|WiKVSPp5}fxFXB}LrUPydAXg*p# z@f_L5?^mLI0=7wDj#Sr74niJ3qchtRy=EoXF8{bKcs8LT_FO#&qd|+E2~L*;YJ9=HYW_#61co*v+#J`7x$JDbp8B<}k=o8(}B?(_W}tZT3@vS*Yp zI<)|6b~*#=v7 zC$eRJPqII?gFV{9AEOuJ+ACGW)F~{tC{Gv%T38sen<#L{x5MlSE9VZNLkG4$-*F@Dh0R8Je7mV!C^z(>Oa37HmMQ!q37Ynyp81%AJr=Npfo;jEkP z#CE|glf%hgd(;X$Hu%?kT7;q?&?+0f=`$1*Ci?rUj+?mhey1cLGBL(RK0a{GROON@G+ zye9Y*mw@H0*@6t~5ZUW4Z=o#j4@7#L2bgD2&r^<+7Vap;{WE-gFuT?}@6@It*315*bS<5v~x{vz!+)FET;u{yj|_C7`JLLKAmv z*3oKmK3Ri~NtAEOD{IOW$_|sZ_K(7Ypv_)9)GL%3zCkLcLuTTwt?H{ao^(>aN!tWE z@-dpP2G2;&@-b+a?c%T0_774uH|t=LqDP{E; zy$;bxNOCdBZO@g*A5xokJt~jds~Hq>mnp&uQJ63vJcegN#-BrP{}e!v@1A zdEL@n@jY8w^y$w!nR3wbnVxdvPN=vbe_w~6rj+x%(*PoGiPXKc+`{BKZR1r2Yor?NYC?s zSA;%RMhza_abVEsD2Zf9!A9+n$O|1T#|&H1jh?!&?gs*f3b0>j%U%W1L%XKk{$n!; z^1+WSbLD-xCRu`L3L z4ahdoXNknDu1Tj_qkIwcGGc-$a2{tNS00Yul(`ciZjkMLN&I~97oLsc+Ie}~a_{<_ zvc~mWWCg1;ebycIyU^DNx-zOPQjt2`7!%nvrjmzhUoGSo{(35unE?$rhFThe=GhPDpgX`p{+ zhu(tg6Vh8o1MSzr3L4NW9v8F{I`1;p+d>QK&|5|bl36wRIZ&5xtDVCxJKY%HiDvxZ z#tBWrPS0E)4At56at7 z#=vh|O)Rkk?h%!{ckRzyrsdqJ#q*_o)8$#hE=))c&zT+im5tKU8kPzo{Fr#j9j1|0*o3^u0G_QPUZ(*=|&?grD;^ zBMD^gTD7DJwZ!8?+#YI!Nu3lDHCX#Vt|dLx10%u|!u&S`KoQZ2kVelbK6!!GriK5) zud8L-60QB*PgKh$2};9Mz5=SSMVDLHzW8{eH%#qPijeahF#B-mQ5Da zW2*wc@cn494JUao1Z77sg$y%Ma&0x`8UuO2_kDz0tW_GZDS&%JcZ5H&ph>PaiJ(p} z;)rfHG5$K!IceW7*1hulRHUhwhyqNYq4EzW^@b{~vbEu`q#VSBunk0fC+w6JOzl&a zrOZV*9RQEFEs{q<)`P#(yvNI@Gd7ExNLw5mwra#;(bds6n~x0h4hhU?U3>o8swhKG ziSjHoIrK_$EA1emtlt0r)xuAke4^79Gk;)oV)gf{-Nnd##9Aly^9wT;0Q_@r4HtG| z`H5%JHAPbKsZZj-GfH%6qglvo(~C;Vkk6VblbP$Tcc_)9%~osx`&6MmrPL{#)2gvW#(^EPWY#i&EOr zXc}t7fo720{MwA&OQli|+%bLDrTDS9+3?%S|gye=~j!qwER>a|~6^ z&>NAGt9{I%tG!@%Y??TXS(7qhqTKq8l0i;O%7Rnn-v6y;^ORtZmVpvHbW(qX1Ux>P zJ}wvAGm!SY$ZCiKe**8QZCn+t2F6!`b=~_EHK?V z3d^x9R0hC({oGEx&BC)uPL8UWPqZcpTgIz?_$@7U9mJkHhoy$pXIH+O-3=Mom8fv`4eu=rag}r?G8}`kVuTThpzDx@_rtfyzI=fLh$p?Eoc}ZE}&N zxeW}JUfUgpiZ2dzuf7cnwXW-n3&pId8wgTLEobCg4Pt?+OKmdgryggz)LU8IsDk$^)3h zueyo9_U&Ev)8dU&=PKtNH~>a>@Y{r}ifV_Kw=24&%m8=2mD{HPf#`Mc~t zvKV{>yLMa)snhi*EeEAIDE4Pg=W9)QR#pQm@aM_ieHl=FP*?4GpJp6|(b|4*CtFYG zqO1L`tn($mD;k?OK79hc@e={A78Nw2Lz_)1Lr=4Ok8&m0Vp&pMqMXSO8m88#ma{aY z;w81FEQb+0SGZ3cW-FuTAfe4{z;$KCP-f3y@yMOIqpw+`6d|G1VcQ!L*eN|&jn z)zYkc*VClGm=84mPzQ2mur2&`0~eB}mb>foP7XSiSc+c`6b#9Zk}lt4ijuA%&;KBBthp%KDYO#$4* zw7u35nsZCyP+6QavIn)QAGV}=E&lSSqp}dalnAU4b1=`E-3Y6ngyl`hYsrC@s3j_K z>fmDw&o!QcR(6MEWiRuMrtQl+918rc>L6Bs2MqyibKX%{H;L`49OnLGNDr37fK- zWtZ`IV@`v`RI)U0^OOm$XKQtwMfdWq`pgELT2I5P+O9pdtM!Xrt+oxv%eqYe&EhA` z&8?&NZs(AzINROkPuo~Ngldq$ZR1|YmXP%{`z~l(Jzj3Ecim?-URhN~hLm9JiuLSm zafp^*NOZMyL{hXc{Gvt|s>aVh;O!kLC*WaBr3=(|iP98JVQsBs3Y3ezFU1QM`UP>t z3t09kXR{>C89-@d3LN{Pl}qYzIq_2^@*4Fr$KF|X^$+1n>O!&;f(>56@(n?(k1n&znZO!W-;x8+<6lgV?#=d z6ijh2irlyo7MZS!JH-lM41yjblvc%PXD}2@ky@mZF2|%s9ja8DtSzogyGjexO{`8$ z5m_BbE6>fgmKTYn*6GEQH8=~D)TUQjY!$=kyXvTBRu<;xHdo}!v%G0nmGnSZ<(K9a z$*Iqm<=XQ-J;VH{$}LXJthHupZO;k|D_u9RG&oZ=TLTDp{)F4#m1(xN9*ocLQVbmA z1s?4-Izved%Bm{bj~y0Pjs;FG)_gnpfx)^F+I6F zFE%?J?6fg>xWLKS2<&}qe1x&=eJr%fX(?#)1c0Gdb}681igwSErb~*791Xk+_r2`))LMkUM9m0h-uv#@VIIHUl4+|eI(pKH88yX8M3t_|< zh&A7WtRxVK1ENh%$xByO7g9`mVzk?JN5~0b<#LRij|wf9>%uo?W@o9N{`PGy)K!!A(OjqD0SpbQx;hCA!THoj_X|6K|jMT1@O0I$>2*QYv6L;-QNkO7`jW7(tva_Y3Bv~T{Qy8a0>u*V*nm2G`^{=yvq1kgMklI+mRr!fg7B+qO zW{9yiIa_By1!})(AvzF6?-5_aP1dODoRV{)0cE5)B<}%Q`AgQS%Ul0pd^-EOROcjj9BL5}_ysEQS*I)0>>+Djy(je}Z@#^*>-7 zNam8UOx74h$!VPRTWN&n#-ca19DYsIYr9!(EZ@CQ+30PmiHkNxJh~zTj=flEs06-T z&bK3{F3ib05GoZ8IAMpZTVqMH$-A-6tujVA=9^WDRw8xQ;1MV{Q8duv)JIvC$d5Wg zD&AWaY;DwU!JZ3c?$lgtgmB;yKi!o`UOD^%0kX!YI&q~>jNXeJ^bz*Zhe=8%n<4`#jI2L}B zc=IeS|9(>$Toh@^3#qh}G^=nwhMv7QlbKM$b@USq6@xi|Qs2~6VD3PF=#PbJES95B zV>@73`8~9jvET&u4X|Vs3E5y+E?trtk71qrdVD+nTCd=xNWLniN%hLcY+X=)BL1){ zE;=9n6_29oQigP9RdALw9M?O+bM&3VGTX$YOefHwAZtdQR^m}F4=WX&a;%oPeZ22I z5D!;ZU?e1A6sicIec`Jli=q;sNT$KlN~y6JWS|un_ZAg7Z8RFOb|X>Ah1C#z5GEYp zYoHi~II72&oM_>+hg?Vj80XjkxDMTqU0NwBU{8Ru@>-AE zAEy0sJh3c@oe%@q)gdDcP{xVu`TKPc#!9c9c@Gb^^pl0$5UgQ)kMzA*dyR80p?950 zc*m|+g5iRr{NzK?NuD)hN73{;;mzBFw)pWdG(zNFoDmMsuAK!=n^1RHo;Bk}>H4`p zW7$pi`DTB2Wr4|fK!Schd+Nal=?yKxe_*=tt$ktKMdgV1kOgJp=_h)wKA#|E)fQy= z9Vkx6M!iJk;SKT0c&tCwXjs31hwoqMdV1T4Tz7C>Rle?}JFCPv+ZtUZc4B!pJ#Fl_ zl{))sJ;0tp-U9dXpYZEvJ8$oIZ+B1oG(NR_Ofm4eHWHh-vOZHId6=yza%Jl8Mfo1o zYy+h3JD)wrKi_)nystlF-&Ta4P{FRW;K4UNmjbr8wS=4*ZVhAGq!w3=^)RRj?4yGu zv-Cy%WXJ7$h1qGKyufZKdWOQe_A+#v`e9&;+-<9r^@x+w(|hZ6OtDRKMik4H0&`X z8C%{X^4A~R{bOM%uP=W^=%ja%ue;%gAu#5*?H3DDMdM=KQv@|10kuu=uJiW$;;x}w zjjJSIr5t8|F|zEg!cI87tXx-pK$N-+y*n^6TA3sf0SZvVtl^}#U&b78;^+$*+4q_E zKm`SfinkPAu9iM8vP8ObXz(fVqWPzjw4{?mT%|&N%?5c}vqr0FL!|UQEKX6Cm3Z%S zdDno6^f$*$7{sRcyl|=h#s&|_JunDJ@@D8(zOMOCpe08txmXG^kd5gG%F;9yKOhW& z5nwO0VMFlfv!9FFOVayvE!F%b#7mblETU9YI?OxjPhCHbcRm^ZZ~5E*$;$o@d;$yW z|6d08KdglR!cS0gwK1dh6NhiT?@mPrLrWEW_HUJc z=D!OY88YJkudH(g$nOmD|1KNA#>DzRm+@bm|34}rY0ZyCrqLsVZu7|Y*tMej z(j|u=6C5zc)E)~@-2Vh;r%(VMCJ1Zy{K(p}ETA>Ix9@&D5|XOnx{TVZM&9b3&v=j3 z395nn?t43%AC>ztM*;y&nu+B3H>qxqcp4d;Pg(G*4}RN@AZna{8Rz^dQL7j`D2hp`Kb|-`@hp zn_4;2s6?UIn16d)cjB$zTQEMWwYYuQnKtk`|7ug!gyqm_&9eL(Rr+kAj=9lao+4?` zR~}tq;K^S}tQmHmtUAnc$90P}WEHK7O=WLItP1K%wW2)CWu$IS*OF+wslG*orxvW3 zFiubY`T(2a1y+>1)suJZ{LPY0&0U!pyy86O9y`~fe#k6-_Y@vCF_L{OU@?9qgco!T zZlZjky3gF3FEf8Qg-LY@%QAnU^32?0jaQwp(I3xym&{d>%vIH(Nqf^g{A*cnFWqCQ zv%M5#zTa|xpgigyvlU~#Qr!+E!-?TcE&eCxA~&^_!Ay)oV|sVz-g&j`i6Mt!2c z(mYxnSLw2j&;{MU#kk#$Y20I#8=h3jHQjUF56xETRbQVe=*dWWM>y-9Y;^-pwj_dd z%238xKRydOce&{`UjbpZ^m7pX2m@^UQ!`U-qTn~nW5FVmTr#ipuU%WYuBi+XpI*T6 zp6LHK{Ae~Nw*Q%E|9idADLU#q{98Oqc8-SskqYYB8~&TI|L@Dj)Xv^P$VAWX-*S-B z`!AmDdmX8o8aSBPYtrMh(ErcD$i{}x_6qLk|FZE<@1N|S&HtwV_a$bYu~BV+hq^uK-iZy)~I z`zQO?{y+Qv!?UnL{-dnly8n*4;}`I_fzfpGV5sye`JfqAT%j~pN5{+U!74GVtN3jFOq%MIGS)<%>y`^r9CMR+ zLqwrv{7z-Zk&g-P)6<*RmbY_|=i};G$C8G7R!53SGao-OBfm?o)BUR;&E4r4IKdFO zZ+&Eh{J{>)CS`yuLa*f&bj8)jO3uO&I6^D<_uh<7WBa3tD=7`Bzsw=xV@ z*`pHqdi1ErJLj+DExX4v9%3wG+bKpF0=8LF*K!I<@as0PPf& zi9H(G+v*;Q@%BZy1zoP5gd_NEtGsWi=KqP!|A%h{1Wk{LeZ-5N=~QYy1G0DNI5qge z8M0$dQYNNDPDmyMVKXRzt@&tV>cw*1)(+XTGjc7kS^k!j1C&Hgl5n5Fj!zL@z`c#s ztl#d7q$O?L4uXmo+goFuRY7onhHe;X-xSri!XUan3MwOzuMhW694mddnv6G>$o$d` zRx=s9)jllt``_}RLw~jyceJkU&=c&xV0&8lv0T&sPdPE?A~bMAS>aovi?ROe=J|o| z3F~xf4$Y;{U&Kb2lKP=tkY6mX92iEO&e8h_bH^_Mj2oC{|B5t(d|yH?gRwsNu@k%3f67Nhn_V`|6`TpufPT`){tY$msKKpna?l(;9-gcPt< znnl=h;1-MpqraEgaa7fE9oS|DSrZ~bLxF-3ojc6ZpJS_xaANm^Vrn7*0?X_81eKh9 z*#;XFM|T)P3j!5D2g&z#FKEXvVhb00lB4UEuSy60UfmCXF6ud2W{23O07`V0Gb($S z)k_@QF{=EuX&#-a7#Ps}0~C-zs;!ELvr}Lcy2Ko^R%ZAs(+iba%+k!}#4xIw^F)B}Q&cA^i+tM^r{*t1O zsi6~H;G`;zYmF@?C~z%n$JzLv+Oah9ijRuO!X!{VijIkK+$_o&oe7rLuCMl}cpHz; zSUv5vo+)WuOeUWWK)Y*I{G_Ad3YYt&;G%-1D@!f^cE%iLmLvNLXfz z?B(r^#fR3Xqb^36&dm^39LG<*}Bap=ofifpE$ohKf+W^9rT|CsB zL0oUp)iIcx6PaNY4rrwb1g6l2z-jazC|4#Qfm*Y*nx80*{>)kkz`>SKYK?2z7b7m| ze`S}IIMVJ7ei(#(keX3NQ2UZhEC>fSHz>ok=(_JkL$0N%H1dX2{V{a6KO@4nfm$o; z5Soi#e9ag9J6erBpg@d6?!eDN)934Zv-X{Af}yMAOR(GwKnL%`7_{N%3~Ko`nNA-+ z23-;$6dIjf3|I%+g@#!F(N{ACpF^M+_j@55Q#nL(=Uj+iJ_`Sk!b1|%mzz=mayeMe z3_}R6uRB`4fs7qAT1eWZx#J-ABr%~PO5)eRG7^mP99*KL3K}Vv4pl>F7V7B4W@V2P zot8y^Xh{#>Ute?H!VwlcoEh;NV%2QU#Pia^XUfnjiET&Zsv$%Ws_f?@by7 zzB5o(#$z3d&ZUwvZfyx{b}|dzZEe?*GzUVVQhLeGw|_fj)8d>;kjg(`&Y1lE5$h=4 zo(ZlHYGQJi+F!BD8^adTHXwiQGGnH0fk+^PTrsOJPy9nL4b4U0;x3k%1w=xDU)-0) zd@;HdC{|e+zbIyu+F4+2m8E{e2QXazn|wz*<-DG~p;5@B^BL0FsehafttlgN%bm0H zjQQ^7bVhb&sBIX!R?1P*;5NTRr9;Lz<99$WkSV2g9fjrQNSq~5*8CyM8H#5}Cf!V# zn@rWwoVaodRz)tEq1B-ziM@}8tjiA!KgE>9Bqos2_|RMZVJcM0(IO5M0!3=jB>jX1SZPm;;MP_SPhY=>xt2gP*(gnEj$MJCrwevO@IB)7tBh)Vkg`&eW z2hNTF(*}dThpbiPr_i8^X-nN_v!K-Qwft=$64cw(-7xn;rGtB1nYaDv3O#`Y2^j@` zYMF4$Q-~96-tBasW6x>phX~QOv^s-2exqqt2U#1R!Jq7{*CU!=2;X-xgKIpmA<}m%e4NYK`o31W4iGIv4)#^wM{E6 z$eUKq?6rj2!I^9#?V+7oc(X(I!4HJe6Fy#1p8?wazgB2Tiup+m)vYuzO%pB~%n|We zyQ&JuSx^*>Xs9xjKqouvC=Kn~hAL&?xc`N9l0C3B3Oym8!vm3TXV& z-8h|Kds!@R-h}^JhFlME{<58l@^*!{a^H!Fn_7!}U8;KUp005d7IiltMC$Tpa60o9 z7km{6A0ljz<6yvz8|Ge!kXfOtbYf;u(o_5nohWm@C=lCUuD% z&}P6hnhFlJJ3RLI2GoOeD>9rp&*NKbI~hr^EV+TJo9wcCU3X;LaCJ98eCji1^R7P_ z%%a11d>Nnm`0SsgUme%lG}nj)ChA?zER<7Z2+;Sn~|F~r?uFq zL~3R~R@^KNDenURtkdeY8y0m<&jM@p+O{9evn}yGOF^tMe_9o~7t5{>t zt2|bEV~;%6`zk1yW%Uy1R*k?kC<`ljHy0Uz)7Zbs@)~jPrPMc1>P?2UIdo@(72bmW zO*Z^78Rk;YNZtrjF_^I`a-}Vy#Juij(Q0-m2DiDt;`pi;mW5#@p>|DAUO(t-4N#$8 zXU;`XKUujaEs?fNYkE0@Zme2jw9kupKIGkRB$A}5)QJ;U)!M`w2e5I_BI?ziW)rjb zgXafCQmZ3jb8(dGYJVMG*GaCMDYifFOj)35pUwNbKW*0rWRpG*JwMG-#UkVNq(8v# zipfZ2sv--2#IOT*nz#s%VgB;ZWE*n}F~2KB|1CZ{qbjosXYhA)J1IvzD3CFJESkt) z8B``{%8;F=uZ)qKt`CXvy$;%W*rp8ngVAAhnp%ivFN@S)7*rsr@{ZAio%FgG+Mo-X z&j`^(F9RBeQE5zWlo%0pa`c)P$weke)Sy{5h=%GA0jt);(+xU}YSPwNgpUC)&;S#y=eft_qK! zc7C4KFWlHQ+rJffo-#Z}QYl`zWunD)`+!9l5P{!E_r%rL2myCa)2^K%X~twOHb~*X zYwWcK?^z4tKH-?)v}CP~Y&?F%G&frsU^O}J_k>jupR??_>akresk>;CH(*YXa^s}9 z@UD>-?EUPahWIs=iroV^_~D$))e|zpJ#^xbKT#%0Hv;NrhvAO05zWpjwcKwX?;uas zj7*pY(W$*cp;tN?8#A~@&;pfB@i|`d?0=&*4Kd*zTvob^mLY2OvLRX30U3L>999jZ z(o6Zb)5TyWh{l`m?uA^-9wsjf(iwb7&x1Pu_e7#2;!KQG*^JT^OX^Fw8=W9DK|}>?tA1bwFoX&67P67 zOWE*nG=#|gTVY=Z!+ke+JfCU5&#&bOp99^(wRk!eYscL>dZH67nT!ptVK$-b3>e|Z zJ}s8xV2tYs5@8_N<6(^HZ8R=sV)Y5y&*gUGCz$1uM{d`-kC3b5Nj7~LyY9t~5}$_% z;SjTkm3W&^dh{w`Nb%MgZkctO2-T85y|LMXwRu=)#Xgv_y|Dr~h#^wv)yM)#D%JhWAVx`s6Y!;h1pMp~J&1e85WDptF5__Hntz%`^}iGp_m?R6 z_Y>5m*j9=zBF$2SxJ$Xo>^@4`P?;UBk`%|JlE}p13;C%Q%pp1}`SHwpg|sRAIZ+VX zVs`xAjovFCM2_=WU8dR~gDCwqmv0wBggAaEIO~HP2Pr$Fm4#!tdWH#9)N39WhKN_(nZ_ipm(}I66}f9aSCrf!>ZwCTY!| z2lc-#>#z@i+2<-!?g%zUI&h)}n)pAhrBq2Kyb+24OTe0}3d?K9ja{aoP zHVSs*YQ8xC?I&3^9}(Osi3a9oP2RlwPFCwiM^#BYu||^d zwjUN_{_1`?4h$gf?Amj~y=1yK^g*J=_eJEx{PN$~^j-}z_rt?%e@WD=Z#~*ods1Q4 znPA8s>yJ-JiCx@g$xjwWsyQF?t5CNggn~5^&_r#nt4Bh zA3K{bWK=b(OxZ2QJ3rmoccg{R!Ae6^Q80dtIBb7KdJHb=;0!MKdP$M#HK1tt#(x(SU(MNoZ6CR;wiox?$TU5S!|cF#H9a2%SSJ6h!H{DFp2yhE z{CS=}B(oBtDTn1g%0YU$}UN0|H;ChEMAVqd|jN|R-5%VwqNJ|*P* zLEq*ku=3~Wy#9Pel1&fhVi1B49~bbnd~iyw9hD^0ql+x<2O<`SCI+lM76H%H>qTV2 zBG`t2Ey4~6KoVgezXld*RyuRo%Tdg)ik7Izo})@fZT}o@>p}fOx9A;~q|@3CV#d!^=L2;RCnijS z_1J!Tc+3W=;(gvm-9*`?VQHxB?>8{BmJjbm_Fsiu?Pz2De7Jnpy5Y+51X!+}P2sxQ zTMlU^-+?|;ERA0Dva2l+_d*dy7qwqA&zzGQ&2(dI7adK`V5-YBf@|-vcM?k|w?zs; zbO?~yVQ-Q85c-J!_*r^vZFR}wz*0d`mVQJ_1!&1sXKd>QN5Q8%S_lgU@frh@18ykV zOWW&`KL1)fzLI^elpzE$3)0j_^s28n(5dd9lTUJd`UYb@WLuB@C)~qfHp-nONmD6wG3reQzD61^(QC5T*rj+&7RXdx*Pwdv?#r zK4qUROyaOvUU3hFf&WZVPf7l|OMRicr*r*Vp^whZTP|+_5&A0jrS=wza-s7+RRIZ; zWV~?C_G_k3Ej>CcNMEOkb9EKF=}v-0!6>7W{81PxW!M{MXp&PE6tPPJsg6!Q=klHo z{0aE|3$R{+Sc{+AfLzY{81N3ba6IZ1b!Bru|A}xsuRtMJ?sL4!@)6wqYwr?O&*Yev ze6R1rMvMu5`0yofK|yngn(4JLu&4aM(vfQF5Xc!9R~r`)^vXB(l;<#ZxKmCa)@$De zg10kR11be>)=+>CvoJ6g@MuG)2{Syzqw*V}2^5be{N*JKDrH)0D_3j0bm!k)xZkZy zPXx9bMhA8nASJx%k~%szM5XKKo%mf~QprfbGKvyVeV?&0uGPpz$=Ir(5$6LL5@jPpF zZ_O*t8$)|^)UBr1-@rjYg%0;cynR4fcntQ>`N7$uKQk*CeylDk6vqNDvhlL_iS%L6RAD5m;G*2r3|=D>*2V|12Q?uhP3!=X7^f-@aG(_jCKv z)3>YYgs)DWI$u|N-o5Ldbo@i#`~6p12fzFIC3`>m(+k!)f6)uyz5Tqe%zEvX>yCZv z>)&1cu0_|Lvgp#Ue*Mf{&Rg=-ysvL_+*41TyW%r9?Doyit^3f;fBN!SuU})q;hVqx zT_;bzu+D1NJ^uUW&iVQUtF|wA?ymFhTJ~Qj-L&gEOSjqJrL`Vw%vgKluk7%pLsxFJ z$Is5+XSHA4cQyCubbFO8dpe(3R$2Y<#-7vu z>x?}&nse8+`#t}=i*EYfUmpD2X7Q~b_{@iI`S~7CUH$eO9{B7H5B}u7UD{X9xPQa( zbsjr>^!c&n@BP!U7d*4?`R6tM{o@Zdk3Hix>%aKrJ-+qBRk~-rZO?x`{enYJj1T(Q z=PrKnpe=rL{`I?@@#Ow5ZgBq-`~P6ce(y+Ed(&TjwegQW@$8kC%>Df7H=T6LmdBp? zle12_?6S{q`q1y^E_!C4<1f5__47Y?f9Jeg{_Rayu5$B-M^8R*i`LgRyK~uFKl!mO z&N*h&o&W99T~Ghe30GhE(Tg{nbNX{jj(qgGiM5V=^M~hsdFGb)o&CgmV~4%;%j1vz z>t0vSzH93r?tR~;M}6(`Prta=%Wv*JIp-s1Jat&(+SPvYm8(Da+s{6=!(RJcc{HFg|{kd&_`lItcf6Ar* zw{r8_uY2MhFF$fX_P-0(d*gxYog7cxc-{lQT{P#tYeYM}>7wypzwft4z3;ORjNH4) zna5mu!|baz-DBZ#mww@-EtY+8@`Y&Pl{MbF!6{oj_}J}RymQgL*FAsU<2PRUt6zL; zi#NS@+dKAn_Ki>ddEs|X{Ky`kym^ytk9qTvyUd@z*7!?%|7PurH~+wOw_i5<)*Jt{ z{+$oZ-2Q9VtbOgXSA6jH>mQpw`=LLc`m2-fyL}?M_}UW>`uePW-*x?2xBcbS#ofpD z{Pdhd{`9TYPr>>|V0nQSaSnud_PaZno@ghd#a4i)Y<- z>|2gn^SB*<^-s@SeeK)lZ@u_E`@i=2e|h4vO~;$7J+^L5Xx ze8YPed~*Gl*52TbYu9@E7n|?+&?d*Mdh&&vY_sM|TOa(NpS^#BCsthboi}_V{@X?O zeD5`n-gW<_d+z!l2Q9qqlZ|h_@sI;vcg}jReP;F7jeh*7*RFc&lii=Zy7jAHymH-t zdExGlE&l#B$sf15oqx{#+wOYHiXXL~{Qa4) ze(8h@UpV~z_dR&uD%W2BIql z-`ezuhrav$e|he=FTP>x$1c0@p(Bs~*+ma+6WuoB_>DSiTzA508$7Vq=V#rt(Q~`K z^tE4Zbn0P8|I67O5Kua6eCDiqCtPyMcelOu&;RlA&+p&hBYW&VZP#6%`_jKIIr_Nu z|Mc)y-~8PX4`08>DJO0A!>3;V$d7hD`<$;ldFTd{(=OTSdrzLb|5mF%_OtmHpRn~h zM;-XbjsAA$ti{v*bj-?g|Lf3mH~Q^U@3?EDmrniuo##KX*-xJx-T$c9oOAq6+i$ia zTJtT>{qT(|HpKV;AO3%wj;xzdXOw;ZMBui=TbKJe}9uKL|~-t)bqAOFkme|Y`0`_6g%n}1m48^4?JrH-+tJ(*KB^x>esxy)?KrHdcq$+wEExH`oGP8zVcH)UH{nsz5U9^ z&RpyG*}ZH-nip!J8gH=l6^k=>ATn6@x?P6Yi@e&XD)mAlP~Y_;iU)t)749k`r38}pB1k= z?a{r@dHjnXTYUGe;~!n{$~(6E=hnU-JLbI)U;5;?A3lDgowt1YfzDfwUV8FYr`++K z)i-bzYmRy3mA`#^zYC6f`n0{4?0(QC zAG_l49d175<2!!hwXeJR^b;<*;GXqQoO|9YtK75N#vi!nP4~=M>(jG0fBohk`Oi;% zZIe?EOm|#+<5Q1a{axqo`i|FZv%_)G#%qp$;|Eu5d+x3?Z;6thb~gFIO+P>GrAJRc zY4bDReZaJ<)>^N9Te{f~E_rp;AKY^1rn$u~VhdLuR*+@AGqu`jv$xwjwRhj!H15^9 z%w)ALW6M@-Idfv^LTohidY7~lq28t4YD7sh#ddX)78Sg7o0(Jaf(n;j!3%zv6ji*4 zeQI~>I?X$=x}CFaZEsZXciR6f!{^85yztRaeeuza|LH5oy<_c}H@)G+In&<#=xS>n zz5S`5`OX@9|Mi9EZoc5sJ6Cz+=KD{+Z0nOx`SnFt{C=IEyg1{x%@eP=@`md=_x^a* zLqE0e;!Q3(?$KwT{q!T3y>!EzLx1_3XF4k6d=|`|p^w)3?UQXMX=H4~>8R zL>e?*7cbuJO5V-~Pw-kN)K5yPh`lf$_a(?|;ir&f0PBt09Cy|4Mz&wuykwU4~x1M;!=^K5uyX$>B-g^J{x#Q$Bv!C-!}0i$tWl(<&(oDYdZN(vTRoF;yBO$|lVJMEQm(;pph{5K&TL$}U6+hIs}hA|v8& zQ9L0FDDbx|<>;s~5bD z@B{GzG_%|Ci3PilPwqRq+w8fc^T&^v+|RD{vg}?;dbhE~u#Wb(40p+3vK{MkkG?qwJ;KO4{vi7I*d= zoj-QKiqYMLJ1$?jU{bw)g{ak;g{mGjwW1+gvTD#Gl+3uLbbrsD2_!K+i!vdjc~;+& z_#fG~*y>vn)4rw5cmAGogI7(-O%y}9a?85^NNYne*i_%tfsnRN+mYpOe|Jy7JT}!g zbqJT!x6~>toi(u%t{G!$LdhE(QkG%Knm6+wwtK68*A=Pir_t0;C5)J#Doh!jzhrXh z_||jh%$?h8rYIB368sM(V+pRX`(`=^|C_D;Ek)^=yfBx20nX#t#NCj?P>$v?SiGuoGxq+@Txob1eMHc^s(EtRehM# z^l(NmswFMen@AbD9C{a~#E`muU_j>DAEx4^<1hn*H$owioPER1QHehz?b4u)v^!h2 zq|M!L_&Y3Hx@6h7j?x8P&z?(exCx?y47ZxbqsMFXcX%D}#zIsah8So~3{L z{KPy1s4D|tN1g~|buJY_xhLj|K$Y|cqmmLqn~1;zLUlz@WCn8nqB8LKW1cIhwP8gW zbX*y*_>j25z}oGSc4>Sytah;oa_k-pBsW+eTEk?ziD}d}w1&xK6M1Hvx@KPB>B67^ zcGAGaRl+H*62NhlAvg5`k5z~@BJwQa%~huWHE}c=68F%bNFoTX(u+tx;&NozZuz*3 zOJa#;m3sny6qyL)as;f|9+~}QuWjZRF+^z(aqt{dHv2WFcayFOfwaKoSm`VnhuCP1 zKJ{#Ls!P^f7<<5X7!t9XPv{zbzzXpUUTC_+9BTNS@(=jB_Ax1Es9p}3ngB9bW&PNF za%|bcvE>T|0;pt9Wxpd4kbFzYz@^rcfkc5#ti;;d59B!6;LD>xXYj$EsTO1^^odC9 zGerw6i2v&j-nKbw?0MlIW7fIm?~GkyNM*&7n8)Uf7KXk{It#9P@{yyb&d2hQ#RjOe-xXtS#6Spt z5cxR6w>NSM&Cq1v>#ahkCOsr#RCb;OJTh5ctP0x0B}=b?-cxL#&w zdLnd%5QKdF_bJB)Z0Hd$E;ji((|;-?WuP;5@!bwr_wq$0Mn5Fox3mK|cGwEXz?OuO%DN|MF8P)r4!%J5xzH!v ztE4M6;+{-`1VBg6^U8J_4JAV|_qEEgz_Gz#L~v}71U)DqDjm2qz?Q_x5OtS>PjBTf z$H^S991EPm_Z9SE+2>k(In*ogsWEul0IjiWLvXs%E(hM)U2)<8-4|=}ZHHrDyFctB z2`BlM5{Ij6cln~1!(?XX343bzzVt4%*U|xq)H42C$&mPdySyK^`J+@VFdA@tp9H<~ zEj}HzgP}gu_vJXL5>SX(hC|Na`vX1_fTK*etU={)H3nZ`fO;};eLn<-YIMcp`<-&= zaYQenD`X`2tWcnO6$QSwCA0_R9t(CifFZPy0rF!U;$DYb0YV^hSM%@)__Un`*Z|&9{2h3?c z9Q!(bVINX%uI59qZ?Muv?xB;1eX^AjBdjs`Do1Ics9TsYt}=?nRXe03l5RK%iXzJD z1qaAABjbr=r_-!_SIO{Y7}Sx-5rVqqKG;iq%h6IF?1smHvK+c{&Jnp&XYj13Ixpu~ zWAL`qTVu~#`*zFmS0lh+^Gko=$;wF{9*BHNTj=kZlk@E4E18?olc*2he zWW{j#2QLR53nT#uD2}B~)*f<^{Bee1c^G2*LtaQ2HABFuPIq#w!>RfsOd4I_w5NxCyx z;hXcNGp7?QsbcmJ#CB!~vQ~%!83O}~7JC~dYOKs3Bz2(JJsk-sxnqs3?! z=wAZ11zG|yED6^He4Lfqy>S9YzF8E>%KK0a^c65-gPx2zBw&nC)*P6cVIfM92J#|C z)lRVh>LG%e7Y$V=G8~yGpCsd9i@5&KSImelYod)HL=NY}Fm2>nAX11pNJuD{h6oD+mI{VOT*fGJ04Qjw^)o3mhTPU{SuN*zk1vpoRnrtiTl56Mc9BryAL<$k1t& z;R}Q^gqldnlKNx?UP;s+u>=)1?)c?vyxLGKm=OCfM@~;meM8&FsLV|oxahuu%6;&dv zwO~-lWgJAZM7X#^j!D|J@KuCBQ9-_^xXnQbp};ClK{PRhARigHQtU-c1@c3rs=33g z!$xNc4MF^esMfFx)R4=8P%V|11p|jlHfU%^k+Nc-f?=U(fzsK+LlJO1Ly;P)s|2T} z618d3KCt$I~kh`jDRmlIVvh(U5fy26~7=qBbmKchR zAvcDREfqTiPrz2Og2>RLBIyHSU1JLQBU8!mPF@x06OqlIsMM<_wuFdUf>;!hVjYB; zK`>C|QYj)2rND7gyQ004Am|(_UsPfY3a)EOp};szjW@A|a?EgrV6E{g34x|VJ?s$; z*R_OD1XQNNok*b^GF&N0s0*`Dd(NUC&Wb!Vl0itJ$P~nI+0KNNcZq4%3#SZ?C{nHj zoHE=RB?#6XPqnq96UCS4LnoQ|n3`(~9*T)ki-h{H7K3q0m9f)cq5|I{vI!TJT$IKV zL4=E_T}KK9#+l2xh=NEL_4<IZs3JEjCR-|& zL(O=`P@l9Z11Ah8A~K{1BAyCCrd^<4#XZzlkVw1bbB4wVMI;$CPUOa!9$LsCI+WwG zwuc0fB%*dCX`UFn;k*>%?Q_(uH87e*#D4)iy&4gSAMOth=7u5^2rQwS_fTDzm zKlF5=hE4gqA@_!8S)*2oh=uSjUp7@%Pt?5Z+J)-j&CU1M)ime^>nCZ zrC%wFW!ZnRHU`slyMfw0B6Jat4ZB^EnTtK_9t{VzG;Jj%r&NuFe{6UbO5nmJ)e#fS z7=sY2Ru?_SDBoSInYtLIgQwUqP?S=nKyoq4b6kgOpnV3HC@4jND>2ZZ_)?Y6hk0We zOf{!lfxaolcRS?aVYq^*5Lws}9m)jVMm_8o?J>2a&@)Fz2!@8>_Q&@fe>Hj3>W}5Y zQysFw+CxVfl1S_x$l(pmLk$foHbbB9(N~X@CRZ&RIb$k=U-#_q7-tN#ycG;tD*GSk>BBhbjz#NFgY&ttEvb z`+o9Qx1$jcetLhCA*eJ>(;0RmOzByOPS9`)+3hj`9q(SfBIe#jI}**FnIr-^HIAx9)m4?KIY z^=5K&QjgNTNCg-wQ*5{##4rVt6x)dFq%z^qhm*>WH-SPznij7sZrV6$g+xTSljh>5 zr&`^Sg`(y3AqyJPc-TyXkV1|{if~)e0H~7&k!oT^4htK8kXCFL@vw=8Boey^9;RQ- z#GN5i#fIAz8zw`X%PWdKr+>JHDN}!8nz3gO^aTcij<`H%I(3Y;E#i({CIl@sPKj$zV3*TZPihERpeRPLTuYTb|-T)gn` zTU;shSx7`bX%l?x0T zmESKm(^Op$m#Chwi8MQ28=+_d~{(0hw|3s285*j~_8Pdwjvf^0CP! z6U*dj&^s+zHa`ErSC=-T?0|zn zgd!8vn@MWiTm{2~YmKN4IHrt##2?b0#UFYaaZS{7PK%?Qen~tCs!5}s$^@A#PVA#W z>cMr7jGN@LcoH9lM&|$$b;?JXd4|C?2`=kwf;SIQ08pKV8YeT!AP!SKb=baQ zYa=gTn)vGEhh!dB4j`$(-%0xA?;tQIZXrCh*a|de)pCm>J!s4#{TXJ)GBH%D#GIj{ z^bYIP5~Z`a=VSejlPC&^bks!gAx1_+GL}>&o-d*GZ2^%%57vS zuvE3?WnBtFDjHYH*A|W>rN zY2&bQ%EQ`l^r3hkWhRk7ageNG;-Sk7!Y2yUVCWJ=4W88o-B_t)jENzWDeDvHWY`-@ z5NtN}@F!fA$SAG4N^lw^nL8vCq1Z9CQWVW3ti5ue>TP-^rd-_BijTEnLMn@~QJ|P0 zprRqB=THw<3%wedf-dAcMyrv?QF0R~-%=WcGHegAb)lnuqKooLV-WpufQoObBpwEZ zs}C8CgjuPx1gAbxzSFdGO)Ds#?(>m9Oyy|_cJ9D0kdN^(HZP8uyw&}rMOC50l} z%w2PNm@9+mj~61!vvh;#LXJr6Xv)JaV|AXDOdwG{1P3+Tp+pK@gcOE4;o68ydW0Hg zpO}eN7*Zl`yB_w8QH0DV4cJ3fo`(Ww1?os*QAaANhkle;y{K6FgOEawIf~qEE@ve1 zoPXlLl*JjTCItQ!;3SAPl2|M%Z;QcrZ4RDr&C^5La0St4XonOOX*4LLt0jdZYsd}h zd}OnFv4lhb0ZfKKqO3sP$(=qt2coz-sQ?^yc!xY2{UUH8Yv;XAYS9x0Xq>q@vkIh< z#3GG&yJZUk2`$$+gGeJuEh!WjXD(?Z@h~NRQ6IGSrXQ0`8?X=UnaT7pClg2hAWFc!%L)Wi4=m? z z!Xy>ABZ=P*jp=B*83P-{uiir}|Ej#2#Vw*@mXi;8E3br}gLdac|S744{FSozw5*u6C zbRu#H0?S%*aB#vFgj~$igq>t{lz6F%b!&AfM=>@|$ak0Ypk6$oTv?!kUi4^niaQ!G zTn$xVkR%p^q#913z^mK9))Q&kQ^linVX*|fjRvnfa!Djf1rkT1s?MuJ1v2?W3Z5c? z0Z75NNGsyb4Qhhqx4fLVb)l2}X*uZ7yP1~&bODFmTq zEh!Y4LM~X!mWBpZhQOg+2?%A5MbQ!^*qusJMsauSkS4Vl71eZ-Hn8i8?Jq|&>UG6U z8~dyfUWY=J8a0jj(+UT|q}G8j)nq|tbM>O(N+I7q)o{5G%A+jTAo|Q>VmpJFLU~|4 zR8!D%I_Z!Au)n)j?2yKHVpOe=M!RwY@q^9~rRG4C)KCbBK*|@Vu37ZC<%4}F>4v>A>QdEs3uYqE=t!;yt`CQK!qz^1rM)g5K<_>2~~nlCyokK zlGLJ-R1*T3%+-sEB|iuuI7^>iV3+1nNzx!PMLpZh(Tar=>fI$GsfiOhhDntj129Y> zzZyE5K0Is=*EeL880NBejE6!2eAp0$0mMT>FgvwKJziT3#tAuUE{h77Y0*l&-Ew3> z;|ckq5_^zKpL$Zru}Gv+)7(>GQqNf-jzO4xx2k(^*ce1ff@=-(UBi__5mcz7Whh`u zWbdG=NAUgnKs>YfwZ8Dg^0$#X_i8bC*hDAKWli-h@AtMTtN1cEVB* z$Hdi%3>5p&iTto4iUx>g%HwQ3l~rLj1*4T5HAAZk2gIa)zEMF9J;`jV7nRt9LaSO* zC_t-R(oyPRySN5XVP$GVHY!E1|4FQ&e5x3xH7KGGbyQFFx+4fh)ak=B=-lPuHw{7x z1=gUbGE@lC?n#>;TZM>U!pTefg)`9ci6k^1RI1vo{c2@k<&5K^!$(-wlfRy1GDM3*8^rb1r4p=%aU2|$bRBTwGkL9&?qo6u37@s-5Xkz(zqd7h5z+2?4 z8H*;zm*Y;ei935PSvYxMqdUEobVf$EA78Tgz{y60;{)Ta{v4x8WvGAx*>Tx81| z+Q^ixMWzxVGT*3Er>CO{eHOF$Lpy~&QxkVgWTy`&!X49=KGpztR5d96&^41I`tzu` zW6D7EhpiwVmGT#Y(vs2yXWTJUW@5}zvjXr>rinz=kl~Ih62Tv87Z`u29T)M3ne_BW zY)15QM9haWzbtG{GH0pfSD2H3(t!f)mFu41f_?c$T)gvgp%888<%l z5QgRtvh`MjE@3>ptzqgyZ)7O}(0MtPzEI+=GE7JnM==aOZ2wFZ$^ohkr!O_UwltU5 zm3lZt`D*HIELCzCx~2)@5v3Mw!rNLIl-h@0s$nzbRNxV%7LUl=En7vLoUL9}ViRgg z8HyZC#N#4I1u9W$QHd(a0g(*$Fi5*WY0_GP=pm?M54mKb)OWhY02GtcAA4I#joH5Sx7F z|GDToRYSzh05)3UotQyBpEdD|@z0lClM^;d1p;8HhKnp8LXqXJH zRy>EJxKilt#aEL8jjcRfD(#%ZkwR{&)I(?*M2Bo&(OR+RQqRdae~%t`R;M-n(`0v2 zLn%uQttvHnEY~tU_44lJy>;Mv?{y@(Xbs~%k`$P8Fm zw`?h3103ZDq+O3SD4-gSAaq8Lbf~;?#}$NJ=Jp|o7zdkEL3pOE0SLl|h8~e7HAj#T zIe01^^HLWUv#1hqBezN#FORS_O4YK8B4OwvGt!@sPiOa^urR6o)UbO}!|q8<%H8dc z=Xe&!NG&=+HKh>FTk2yAXbY8La+ps9W0s*35Gj;nhbx6X^PAYkK!FKqH)w^f=vadm zgoIwY`QYI-8F#6pnH+bq!wL_nD0dNJk&CJsCJpm~$VF)_edG*ZtU%0(B(8ns)+^Dk2OqDf+HCGN5z1UZcmue-G#SFzAa;4BGV4{qGep?}v2c;CZJ5)jB zWj8Zl1&wrTB!PvFiUX^lSI6kd{If`!x_Fn3&U(7Q7QMhCQ+yo~ePu23QqHN0~)BsySTPmfp?Ty zyrW7UN{!w7AzV<+x4%rRL)Imt~ zG24|zZVpc#@-kfI^n7HhKem^8$S?*c>X?V82OdtM;`aBwVXGYpUTP>!nK@Y}lVfMm zgoiNW1pZZ+B6i?UKSGlE%IwvQQl-qk+)J&1*OcJ9uHs?JxKgNK9gY;*4HWdc?fR%v zLllIeAh;d!(Uk_!A=^Q6@~S~RovfB^czPh;T>?`z1AgU2!bSCRBQs>F%&Mg&GKJYd8B|2m({5yP1G&VY zOqTQ)cgTSX#qSR5mJOI_nMk2LA)!Od;YcADFeN!AR0{n9X4-(Ti6F}BYh3B~+it6Y z;gNRBv0*Un(f}@q{FK$wdJm9X)7SGuW==B7%t0=$SbQv)JiJ!Kkv^P)MiD_Iq@jpM z5s4T+dOrMK6R!Y{PB~~eHd}=aVj~q=CXJS-Bs5Yf4pW#7l;L%A zx)s_P4g~2?g{-C`@q~5Dkpc}RJnW~TNQ z<`R-J&j~w@g(@;nA4;J+PaYPOw$Lj4r!us1rdUIIASPO2Ij#-{>O%@y11vG9gEU=f;mVV~)u1{y?8$rOV_BAB8;Ncuv(s6+?~Ev!m^Z*yg65l>Gd^Tps+F8`!efq&An_$S_OIo6pr z&^Yl=p`~I$*x^1L=>$lHQwdH64b=upo; zr?leurzcUAlcj1|%oDGf*i#2AfmmhvyfLKVi>St&X+ru_HUD2}_$|W((*_O9P$w3N zKXjbq_NM~#q-8NrD)kCJK^pa>>J(yIrTyOK%AulHE85Csp0qq?y*PkrF;BeRa!iwd z+@~eq<(=P$BM42yAet%P2+{6Rt3x(g@LJJU(1A0pq4uCE>7tSuXfJ|88q!5eGLH~g zsj;&N%Tr$N8mDyfKISo+Itt>xv=m(=thq85#Ze_wndFvYFVNY%0`;V2QBNxA29OQI zay>#8-50y4BmI8c1+W5_NW0|~9fN6?e-=c^u6Vo#0V-s$gB5SsHZ4PRXyH(MUN+nc z;+)j8%^pZinWi1m_{z!iLK?-@2=f(t-T*oP6NzznHX;YwKFR;Lf(SPQ7rzLp6hi<& zY3l7=srVR!H8Vzr5~txsbVJXfN+b-pD=<)6ia5}Rbx`0AqMx)BWhSh-GXI^*WD51< z(ob3*@`nRtiZv0|EyqW?;v_5A8iHsqLlT7Eb|4)pM|6#>wKUU%ttrLWuoXlAsV5Ro z4?NT~PL-=Pe`_y-XBzrVOYu0wo!of00t2O`&PJ#A(SU3v>_J|j%b=|l=aEA!zJQ&9^6>%iYVeH8RL8fb&9>$IKPm62g1*vlXw9*r% z$eeVj957rd$kMq!q>$nWD=LVfY`|~?k(5tlf)XHeg~YMnCD(s=zvF z_1&)gf{v>I`7S?7RaoMLE5MW@<}y%PvZ{QzJ?p{Mlx5h-0eK3@KePuPwp`uhfFVF> zi$XYIO8Hyn1QcQ|S6yaSW42c=AQV zHO!ph3%iuVW~l)w=#u`_Tzr_bkXnY_qx6q%w9HW`#7`P00&kV40h(loAxC-`E z@(*OlFhg)-D7&NWDd8VX(}vwaMqOTzJD8@s4G7n5SNe9bJE_&gkbqc6Zf(hb1R}Q$ z2dZrt2FmNiKNj>XJ9$v7vYy;B?{Zgw~KO*tC{A}p^`9a87+uEOdMty zey)~0lnn;~6w^dnM!A9riIu2Epm>xx$-zHjxznFhPL9m&}h`d6LF;=0i+Kp zP#cxUV*G=oAQN^>3gt^SR|>r}u~#`ZQb4INBWMAmCq_{o8*0R?WfZo{+BTtG#O;so zgpfS^v?}wfNrmM9+VVxiwT%K{D4q*54NvloEgvflzil{dZF5vi+Yok?Brwl9%2D5w zFOiQ>4qOx;DnSXg^wq#)7)EzLWNg9sj75{<%aQSEHX)@wmn@t-u+g2~N;*@?peUK% z&RQB&Qd5zenhLYjY}%)0OD;8gQ2KP_Mnj!QijnD49r1@*r(}lNsL$8HKN((t{!lpX znBqSDwMpF3JK`gm+BL!*mG8l7+)M|WE{i+nm>$h0!5wq_g|30b9aU_FKU7r({!m-S z;t!qlX{nSi?wGdptSVw9xxe0Umr~`>KYL=q%7e$3O$yz$t!hxgnSvhi-C|V}Z-O}W zU%D^ajm<=tngas#=>x=u)a$to&0jt~K5t?|bYW~cx+4A?eUUF88J#z=bbRNrL$H1{ za5%c#$mn*<$Bz_Onp2YZ#*diXByJusu~0mM2o0lkFNVBnTLk(Ds zSE05Vts1Ph7)@7~tHpVO!7YdbDpVcOwxso~b)x;uT-1v-Cr2}Kv^gll8_}!;a#7>Z z-+k8?U45#}(_EAz>dH4=_ol7NT-3{Sm5Z*q(I&0;v(@hUh;}8tmuN0(40`v1TvRBg zlT_+sO(Qx%r7w}p7D9G1F(t0*eN$H>>8Yz$fD-RWq#-QQl*33fAS2DWi?mdGSN(qN z*pay^9>_?f%j+Xu_8)2K?l%&_C?f5dkp`SdOEl6|L%pjqpGZr!ch$XDVjhXKoO@TL zj7ZlHMB3dWjV!&Za`8x`fWD4Idf#B`s&_FW{h_Q#X3B+$s^9mns=u*blg0WQANtye zwe(}XREv$N8|!9Q{eENiI)sh&^fGl-6L%xlT8g#t$66~>SIyFiwRZG%B-UDrwU%Oi z@BzOnxyJfy=j^IKtQ_ml?DDH}{#Z{dv387D>nGORys`dZo4$_3db2myd%dyV?Toda zV!f-=yXt;wmx+zOl(&o|`rAT@_LfA?FNyY=-c{LIqA@wq`b#umB}$JY`0|E?to=q} zSa+g>^hEnoqP3Oi*d&pR)p?EHRl#FoAWKovaO$(v{)oQfzm;_*nyb;fDtt(EnSAf6 z->bEisOw0gv;=07vaUqW_K7acV^=+ECfdsq?N$0Z()(|v-9!UiqP5n$>i%f$CFZKN zm#FKAzBUp)B`4bJ60OBlV;#S$@uXUtsaiXZ=qp$zN=vC;$Fp?^;G+$zBW>=_1;w>d8((ZRBO3+RaTek+OSml=18iw+q>%aHI}AYyVyjKzL9DS z?OpZr+9xxu)lB=OIdNT`u|5xBrqYHv@!FiRtWH(Nzw6XirnEDnj!+f%)%bc>{T@BD zW!f8yuX6k&=Eys9;+;8PEYmzkepObGX>aXa_51YPXHK%nv|iL{3Fx<;^LkhPKJBIE z^YWQ4hRyW1yff{cna0#id!zbVFy5;%lwXxT^k-WUh3odrRmUXzjie&1(^}57Z>o<) z;_W&fF<0}Azur|@gZapu{;t`G`jXi^>0Ooesc#pFe^=TxU$!Z@j+hVLOkH(+ z)6za`zVKkaDWJY0fcI-_Fhu5-j%V~0v_aj!sjI>q!*(?^$KF-@fBFF$p8jxttAUrAYPUT8ku=tk3y#eralI(a~4Q7jLw=^xooo0 zvKy5@wi}%_HaWI*VlkG9XuQ!@a41%di^q4KSU5iV!4>1XuAE%DWSQvNu7`{-o3UVW z$;7gKRcA)`+IyeIvXx7hs{hwSqvmP!UO^nzn9El#kSkEJBJHh+cN$x^c=PdPTYhl& zca4nhJhuFx9hNPcz?xM2Ili!gUyY;dPVYsly7#k|kB?1GEZ=(WoVjzGO`PP=gdUr) zluJc8Hh{}V|G zO#h1->Rtls6iizDUt^iRhrfmSy7%H(0EK-IE3>W$W9@s*q}>&8@80V~{JBmnR?FnM zM1&6HUMgy-oO@kFCbWMD#RM=p&!MVb1UBTJ1Y~lrD<%zcuOpTM?!9g-*5Bk_B$(aK zJ?Kn?63)E@^)>Xlq$`i2C(j{E#(vvo{G8yEyfw+qG52y7|%)uf@1ZM7UGaxp**JgN?;se60FZi?;zZZ$1 z%Wb2ba{VGEWBmiHv;Lvhl=TmB8v89aJ6T^4QSf^*J>~YV1EXYpmO-8STw5*=$h{87 zjdqt~SVyM4+~0PZBA|5db>-5~z1M+~=yRP^ELq5N9kGle_vGdYxz`net$VMVBZF=v zmW$-MScGxTJ?veG&%HYLu(82ytt%HA<3$v~<~J;M znH^wZ%;c9LY~kON*{F7j;@ z>ktd_aU^a2zO>2Zl60Ak3z%eb!8(EU1vx2-L)e;QK8-`FMY_Qq2c|OKMvi`wkzumW znj&%Fz7Jwy{lj^h)VE-LBIV@%7Fi574nQ5VUA&IH51$@o<3QeljyC}dk^Z(B%apa# zmnP)Q+Rd3ia0VUkAMycQE?pMuAsNKxH!OhIe2KkO7H=R?BvL|7pOMC4@hK8WTvlzl zDeL~W-4)w5&P{V9oByDJ) z0f`iMkuK$O!McY(hX{eakK-<+%%4Nfll@jGj=oPAAiF2e>~m!*1jC+_DMs>Khs&xH zv3RnDawFD1k%ppewB=Tc+Xg}(Cg*mW&GDG>xbMRi*f`oMg@@`*G) zX#RMV?WE1-#&#k%u-xC~tPMoiNih+TfY>r7zl|BT zBh+K_2a3(uoQF&moAZ$D=DNg!mCK6f|Jqo)u;&o8Qh$R~xQ%1Iz;rH*h>jOiJbMm- z7?Ty^aV9J53G(NVcw}v~x$KcMV!wscuO!c1IS5xP8HLkjgJXK8)VOnn~;xIlpZpW?(w+$_+*5Ijn?OOxW)5 zxCv7fw{buY!woDUm=AVkiI3YZ;(OjdSw!nR*J<+nWE=54(|NbUVnR%{42L>M0nq++ zni2C4cq+4JWE~kMcAD~IxNe`3r=fP*i2&|IM`HO#WzdO`G-uE8JOfr5Oa`5Z&-=(u z^7q9}w$4L(lIa)QTg;xZ3}rD$2Qfd@M+d2YevjjGC+4w02k|rYnGV8iYHOHL*xI0j zE;HF9ox^0G@O>97li3;!vp$y#Hod67A?jpv4_5Ik=0e29VsE5!SuD^=<+&BET_L__ z?V>`6$r)8W%*L@mVs?dPBa<_xUuKi2e&KD%uR*x|!;xZ4_E^X>*<*>2uhwCHlZ`Sq%{Gv3*_KOQ`MQo;-fpmKE;F5^(ok+@UcDig;Kq7r$jSB6yDF zcX1Ds3LRUV(zzSYvGp|WF<*#~aichnd)O3VZ2&pwy@buR_^qVuxH3T6g1ryh`(zHq zZ{=Z-?r&3O&sbSW@)UWlN#{m9heSW^b1Eq@{0i9*zjiU0<(#4iAp-UE{iZnasNP-I;;TfnJljt9?4s){={OtnnEsN-S%1GY0? z1&&jj6rf0d3*cowgVLFt=OjhM>7Q_FiU&{E)t1ZL5lH8|WUz98_ws zc^VmWx(|lzB%&@lHp~l5_SiaM?E(&%O=9iBWW{Sf(XRZef$Qg;9E?Efn)R>6@^F9> zNzroOCpNg~*buVvdy>vae#>J=EX6t2iDU+C1Bp@A2G)bjkB~fMvg+`;7L}`9m&mvC z-*%X-2{H!L8y4C8UXHA~td0y2#`ceJkL59OkL5-HVSMgEludK>h`d?t4DMkkhsYVb zWpr(i=j3NI99^P>p2;4maJqI85XH}<>>)q-;rJkC6lTwO8<#!8Y^Gn7=kUHTz5#N`O}dYR-pOx7*?qxi z`JOta1?sDqkvSg>7Ea?jvAU$P!aZatUHLVUwV?SIagWZ)xYyzNcI2Olj>PUh&6|mP z6thv7%=d(`tf2me=Xh+9z`3Zc;S(fmy#Nj>n}6{M5PNMkxqNKN((&aZ;6}p zvKU{I5{zCU0r6!kLEy!I0ng-r%?7D^>ugpwch2nA>=`rK$?Vy4<{~jTE1i+foiTex zItzHc&4~XIL1xBBwPqbSzTlu0D-UjrHfP5(1nH?W8~N+mo$jn|+MF|6Y`f3O=Aisn cu!dJmjxC>*^joYrkyRae=R4=@I(Ov%11xWL!~g&Q delta 11753 zcmcJ#byStz);ElFcY{)bH0%O4C5_T-M7q0??oBreY>-B}OOP&UkZus98>CZIUi3ca zJa?S&ePg`iefB@sT64`c*Svmf#=7R(tNB=`rO24fDpE3B0B*iGOmTRvmi(J_KHRo# zjcZ*)-H3QjEKJ-D2-;=cS0oYAR@eF-<2tdciFSkd99w8y!qA5=9fAN8*yEl)S*;ka zYwxSsEOZDvW>Azp>QSiS1tp7!&+UiXo95NgjLzoo4wlP4x4zqJmS0v__|ZwiDuup& zwS3vRAB)8j{SkGwp=}h7+x*n+UHgI^opukmZVHmyhy3LI+o9NQYq~y_5}fh3!Ltk` zw9#_pku;sP(X#=}H2HGP?T2MxgVf*}M|hx7OvA zON#j%$J3`)Ug3TOQjXstBkgTIb9(x2bfr;LLcJ}NxPm$}Z4RWe<3YYO@7Qn}gAEcw-ZgjjYxq!KL4Sxq5`&vto8*t(CLj zC_LXCpP77Zq&&FLCbIPAa0Y7cRz!G1BZUYjk3VxzL~WE6LeY{kFDVkIY0<{pqe_|A z{?I#~*rP`t#w@=3X;hI}B!}uF9|qhw*FXjMlp>y!rRQdVhhXv(MotcK5%Od~8(sRt zA2D?2aU#PkJ0v%c?fRknqt?2|JX}$!Q4{?g*7K&HoF_y*F*GR$I{MDftgp)HRa#zi zGYS{~TqiI^gMeCYcz0HD<^hdH)uHl_m>pTMD!Y^i&an|`$c4w930Qh8V;XP;i5(zY zZ0OsR;4zcx5xW#%_F!HoY(V1q4uI-NMh|Evku*>q!5!=kBVLnZ4Bwqg_6-L&+ z;dcT4I{UK^SovAg9Z$-`u{7`9``gSsBa?SMkGcsl2Ey~B8=K&PL1TK-yW=lkitC^f zVEW6gIaV_Mbd?tD4pGy4B{0N*Jz?1B@B2W#g@>fWVn>k4{U8q_W!<#cHXvJGr&D%Q z@Z9ksG>}>(k-5q57QDD-i0v0vv`+5ZL8L@kyx+#4&#KZHe7wcFGX7kXc#bW1t6Xj{ zHhclvbgQkS-XRBf%&e`W!l~B2e#j&e@aQE8W)I9KsPAF+lT{ewvw3vCt!qCUQ&cy< z=&P83V&FrhAh#Eo=gc%rq6P^e@aA~utr3Pjhk9(wM?r70(sUb{>q zLNmXwD2QVidv_-ug2vNx59&jKv{k*#kr^{E~g%XCTA0A*MCP_Wwu?E6$k5OIODm;qjC z^GJ`4f?_S4GGtvl2ucfGd;g-4S^{mP+dB=ZtquzVpJaqXZpXag{jU0S0Ha2rfF)Ox z^G=%NQ@cIn;kdP{mZmHOBXt>6wR%ab$oe~b5R>eR#cr(jiH$_bt~(mei^5flF!YA8$m0CUu6Dwpf13$R00noIgpY!DNJ zU2A?$uW*o}JAOCfW{hV4mX1^Ot-_X7oH5@!hDUU~#4V)^*Qj)enB8@lSbzGD#*$;t zT_^!l%eU5-7?czBl<5oDk>Mfow<_-sDSgqcFX1*Nb{54;TVT|;VTF2^B~SUkajx6l zN+pSyW;btYRxLMf68=o%QvT^5MQc$ALVjMk^j00ud$H@tLV2rn4%L0jlyo)P)s)B} zD`I~?FyWkE4EZq7_MzTag*Eu;cbdYH@6-yVy8-XjZj0Siy7f1?o`f_k3Uc)Fh$2})aH zPn=Xf61V~j+UB~b&Uoe!<%ZPTNXDi4t=#6Vn*yW2!h%6LRZ>K4Jx5KL8gaw)6@L3fIkONa z?mWWmEMEeQ^!XznVRVl-2+_RjCi})p$PKw@Oza*o$bzd`QO&;m0R%w^V0un2n+KlnAuyn zSkm($eqcU^YsuSe$Pl)TR*pdp^GoUCsnG+rYpd$NPkH__y2`}I$+)YQLl)ym{g zc+65R?PT42>s#HXONHZyijMpI6r*D% z_PL%DJKH2|s>4xy8ceQht548@chRvttQ@ASBc*2vzeQ6ORf$NqYrcPug*Q>^7?32Q zBo^&!*VBK(V2^W_mrX!P#MBky3_lH!Aw{ook%Fp3_$-J1X7>q~Px}-gXWBgTdw3&9 zPcVnJNUCUVk9JQ-T8p(J0b0nik>0`c29EM#j=96&R7mx3s zMm9ET*EgBL@V1|>0NJc=W=zz@l(hS&|I86FZzQ*ZYHgT^DA|Wau>vQ$QQju`5}Jx}8?E zxSyEYC!0}HaR<0#mpK_Dlu_Xrr!E@%LS)8b? z+h_d@PEOaOS+Z`Aak%LL_1!ECD?{jh(G5jH5=u?D8_nTkv1>T+EC4D+2l;V_{t>6- zl|#vhvGf7)-s?3ad(K0xH%JOgN>QyOB^S}E+k#tL@nNlI%|oEuHZL5~uqOe%&NIu! zz7(~r=iLV|(oRWn)>L>rh=Mg#MOuX16#rKB8Mejf8)cCPe&R`AAADrRW_14~9cDJg z5xcsqS%_kia0jb%$-6VhQ|;KVYQP%rgfs;1mUTQX9mOsrtX89sz^b8{-FT_hp9_UX zB&$rTsk-5Ku+*ty#}SW)4-8)nxQkzjyaw2lxY5`q3(>l_4k6&FMzq<5w2oAk&WaO_ zTzjzhYGDxVhpw1Uk$dAS&&2Fv;?ca{zcxu0MvfgnJSZSC#D6+8R7&j+9Oa$G3N|=< z{?TT#DcCIEkl;V zT5EZRPvYnl3ymn?j%^FJTsthi74NE?edXTR%Q$h%5j0=~$s=tl=0BflsMrkJV+!yY zmG$7!FVrBDb2yIs{Ml4obGNMdMQ!*V#z?&;MU`rUN4hmRIVd%v;>`93x_>oxvim-C zpgDnzwf2bE#=ED^A<7U@3TaOyGt`rp+m%p^EqFYN<*Zl+e;ye2f|5s2=nem?Y&YE} z7&G%D_IszvsZ;HW?s0>rr~>YI}57_*7Ke>o!DC#N&SfyYX*^pI8Pnjg8Re4@FQCHi?P^&>KF9+K_(66>`o z$Lr7M!}VrxiD#FN;Ddc{3 zrx(B;)aN}{56uoc+lfY#JhSO~`TUfJCfIQ(Xd74f z3dKdu#TryI2dmRX6E+NOc~?q_1p0WbNqBeZ#cMaZj5I#FO@MKrS?-|!9_tuqSDp?( zjH|f>&Z{$r8Wf1)OlqX*As42)=$|;2t&>iZk(=W9ntth+E2pT9Pf=qhEC(|x`*^rt zNIK4PL5b8(hJc~10|1zh%1Z5ULxon#jf(Ww+o)-BVFk{?HL zrA8EJB|e8oB_=^ufi~pT7eS3DRIjGB;@-glclJSPN$KG4NV5;75iBc}s6{U%a$=Q~ z&>uR3d|2wT2-`DgWqz2`a7?!&-x6tp?9ez@e2CnsF*V69fj91}331Z8y23nOlGC_g zYqR39-%UeV8dElLN#6#QE}2VTmRc_18Y1Cxr1aSz%zRj0T)4b=X9ldqeNDHxs;7Q}N9LA7SgQ#*Xesc8gFtMtaQS z&-=)Y`H(TmF|`F$%qFx{`JaAad8YFFtClgW;)Ipb`@^%|w69IIE!z%%+T3UGAieb* z8$d%r&6wMxR37+|-(B&IyT!!A;mYUs%TSq$jJJHLV zx(}Cqn_muZoG2c+6c8iPV$9Mc`DP*sghpbaTG|cwLwn+49Irtrv3QQs6!4X&25zCn zH=lKHbF9MQaI1!}0v;FJMmE7TWmi)m7)aX{F8%8Y;e(YCADDN zQpv*SgQmrzv%w_PU{rxe1nyvEu>SoSzTGOVGK&A#Lf^z{j&~_c#&J-+=#p!V#td?NL#fUwB$MNc`SZ|W8;)bE~ zx4zlLltZ@)gW|yL7>?i!Z>p8C7;=WZ_++D_-pXP=E0T?Gj>SV%B~W<5X+PW6X|(Y` z)38pqqv#K@HuI#Y$);2@IrNG|YP$lyof`}f_Q8~0Z==nOuiN|Mv32r&&$_j#dlg#) zArTekkH509rF_Weez%V+X#1Rq04~bGsVLROBtC(oooLD6 z56NMObe3aCEhJscv|NYh0n0OA$CJim6C1OjP1i@!haV7KgkOA?5~<$gnwI<)v5LHv zT~~q@U(1_j0>XP0FOiKtEAT4AMJ2=rn>11np4M04^JW4w_io&%cP*7LqgKMkR}9yw zqmEFr=QPw9Nz&`pn0k-c;+noXk6+C_7^_m3)*KcJnuC4Gsx|B^0absm(7#Up1OUPeA%I^y)LC3 z>i$%;eWK~`i_WH$Bk1bDQ}7LG$3V!Ugd^GD!Ud|ZbyvuSpIJlIOmR+$NZ_%-(+t)^ z$WP3TY#YJX4U)9xaOE>MQ(z26!HLBf(Q29n}oeyD=n`f?Pn`57-?CmYCqf^c?3pmV~k>lR-D@Y61&q%*j zVq>dMREvyG+NPjAswx4ymZY;n-z-sKHB zW?}gB!j@5r;hjt);WGan3Kyln`ma#=w@3>8cO(T00RIz70f2vmQUK!n{fAJimQLxq z46fg3<+1Z>LvEuNJ*ATq+rdIzfM`P71+u)(PTTpB22;$}SB!&NJ8!F?`_I8mLxsu{ z-REOJoUfZf8M`qLn_?v$)OOGbeh_Bge&1j1b7*S6rn&z1{dV<-ALe_yrUc!0VT)hj zyKSxW__pqMUkh`E0?@YOJ?U2AmiAk~wt1#JqGiVnIz>J!T-k<144V_szU3Eci&i{Q zJ0JXOJfE1S%TH-5uDbeAXfA%Z_q45HiTdnh-M-+A&X#Am=-50Qm2{MBK9;>gksFi% z^oiC=Oa`)(>d|RPxQdfG6I0#qqDbR&V|#i%=Mu zTpx*(9_i&am}}?eJXy($lGtKbjB%3)ZLNwK3Db1p*>MfKF(^}?sdKa>JnX?c3L?Lk z()|lFWL|!xR?p#(q$6+HWdlTsQWDO?3jW{@pLsv!^QNUys>!gJhjzLiO9AtrJ9XxO zY^gRxZ4w`!YKkna#l0+w9m|}&t7&SM_7F)+>RrXOICY|2mS7X_(fMe$F0=h;$*wA> z1T9eI)>eWibbO>)d4Z~m%HZ4E-pefNN37jRB^~Ddng$>^dhxY0cUUhzoZ4uE|~(~zRJ-Xc50`Y|;&1t-9`UKR$cawO#{Fbl@8GU?rbY8KlO^6#41x9zZaW2Iz_G zfGT698(}Raik_xn%M=niT-$0+M{puOSu@f4 zL5_MNyj_xa;z4T?ZMy{Y0qzeeChdMyj7y2ovuTsg*(pQRqr6bo5r!HInyD%JOt&c( z)whOXkZn|T?~zs7YXz2a=QQd8sH%?>eoDXf$jLJEbDPA>{%&lrsl^kF z3b3zGq%R>R-X>;U1cPqvhwg~o)nbE9e9?AP5kdEk$yVq3(ee@H&8l@6SuF~A&->PT zxPTuw6X`d@-7;NvK-uOSAH6qD&Wk9`6?^ClX%=7VQ(o;MjTafBmD2Q2hzRmg-nH(t z>pk+i%_DBsJ=&tGS7MjiAKtBI%cti~)@P^2n%rcqrQp;^L;aG|fpc&W(A0s|ltQGK zdf*xz@x?wN+M$bjzQ1JuFfynhH9mSO7tS*w+@~x=7Grm&-OMmYcdpxL?q{CZ^AZMz zq-hYSo5gfS5UgoK>U<_sv#C}x{Dtx7aZwNq?GqU=YQg=yxp7LW{ev8;$C0DLG@n|A zQT5+=Jo(5X|5YVB`v#c~J=$?|5bHFea6J?(at9?ULz7UCu7b+#X1uLyK{wxKhj$gQ zDqOhYup+j%%1KigB9#+PYM~=C9EqDeD*_PkS`1AXdM=DxcuHPM>t}${4RscC|MtAA zkdT}fV(K6PV$&)%Rc_%m$uW3WnEC1rJ%_O_&|zGlDg7Wpg*TDl@O5T?pt!{!@OgI`=C6rS zEKm;YR$zgq&U|-C2iX{I+D=Y2v)#=vN`%ded37IcZA?@Xn>3O5!91fKa0Y!wBqv+S z%tHM$Glr0ESiY(YCiHA~JA(0G*$rTnW$+J*!p3?11{gt6(Q8seQj{wYe3933Hiqok zD@|8MZBynRS#KCqRPN2$%Ip$TF+`XAu7rOJN%h-+xvRNct~&PQK{YMi)yEx(4-bVC)nh9F-c0`Pus zbL-vA49>yu-sIk0)hSncZ4 zb&(^n-o6UxhwrnX<{o`Pj-OQw4-nhOcwCuASm$PiUHOjT``OJ^*NvZlmf%r9yWd^@ z?Pcgg!(WGl2j9a{ES>mD(wZhD6xYY`vL;0DNW|a#aTG{$wo~xZl#7@R;xVCI;d}II ztdL81pShE4MT?`Hw5UjFod~^UB495b-*j^dx(iQHf6a6)-c@8b13k)2Gp@C87m3K1 zn|K?nZ24kn43 z;NVZtellP!{5gz}9;1tS!DF~tF-q5^)t9JjG*|Jup(^()T=t7B=53dMO=N{+-FKI8@YA~Kc*31ZDKC5X*a5Lp z>7#sZBgqoo3A(h`WUF$y`KIE+g)RX&^i*&?r#BfY;F$ICCuigMGUMdxp`jTQt}A&e zPHSX^)&?{kT|@;Lbl7N5+F9*))YKEYQ`E5E@zp{(O~yZT5TAt3Cht*Yj`nk5BJYb0 zGjPO(#$_6>(;vXqO(K31ecV&agEBTMe}&nI!(!>v(A%UFXgd)@)_9xsgMSY%u!p}Sr{kLZ;CinE+=H46*tnk zgAcB4=aUOpDTad(^dduki@FyTuo2r)STvyoXr(xWu;qQsirkofYJ3BnIC7bf zBSMd{(-U8@-Ah_F#AToIQ=i69FqGCIA~4asd>fFCz5*(Jw{1N~bN{b^XcvH(y&+iK zqkWRX)aNVC)Z;>FzCf=b#)z-M9lXk1m=)y^^~AYpkXBs!SGISxnv6 z(sPYa9Hv`0oj?ewJgGI)$S0;%n=Kzy2Az`|gnw(d6@R+P^YmNMnAi&mk<9XKM?1@vGNnW>UWL+>%i9!iYIk?)g>Je5XtC4G_oGQinX<@xlY%C2TLk5wDk8iFsr}QCObL!C|k@ zqU6Wo)zAnLKRJ<*AoUJ6O3d6r(pObtq|?wix2VW?^QB$jL;)fC-%`lGFQ)(y;Q!RT z0Q~<}hQ@g4>WuNi$TW|iR@}=CLQm=eFYqysi-rqe)3;v>s)~Fk;oJ=W$dJ91n z)R@GLU$?_W(^#Nl>06)-(qF^5epY8639z`AB{ zLyPi5kpp#Cri_EAC4Uls4zi&iYZQ4VRql}GKroeML$LTb*e8)d0x$aqc=08_Boq>r z8#M)=+ZN`3=1AVeg`BJAFp4D>WQsoVup4=fKhGqpe$lYE;bE4#={4q)VV@3~1^FmpSCq7fg?Org@T$C+e~*KO8#&eltv|I#-&wmI^w zN~_|cZH4<7p^&snylSu<;%Yv9J{K~lf4Bw@UwmCG+b%oXSD2EP@tQLsTKRipO5^e? zs@KJhjfOkadpd0DwuNcmqY{@0+;|$_(;S|0Ha~vEuMTTZXkHk~zPR*HuKwUuJ1KD? zWM{~#&|^#0^E2-=l)|nzbj{Obz2rQpR9KnP&Y3N z__Ed#mwX@IAU=z|3F5S8HCMpfssNkBUnsYChO~Dj|7ARK;j9>oh_Zf+pl!Y(>qC4* z>gmbo^i&-$(w(GYPUnhlcEP31Iqe48XqLRgc*W*PRgYgy3!^T+_pq{jQC~Su)99e* zCz>WX&OsIDI6?2BsRybQI+;BzyWBdt{25K)d3Hc)))bulXSmUc^EMHNw)85@8!9gbtzy z@Pa`9RBk4Uh4i;j81|o+5vU=Kj(UJFc}Ik(jL}8rhahlXJ4yn7MTEa<_zS?lOa=W3 zJsAK!@K+J&9yuUA@YjhHh8W4C#E@~g2L^PH%xf_cz#j}SGiL`^ClfPgdJq8N7z+`S zb#icZynjnIo)=C=_Rfw*PGim_EL>AP=I^?bow>$TcLk3fe|DK zGZN5myZDoVgTROwL@WBgWGtl6CV7(~6A^=c`#Cm`qM50ck%WVX4n4vzmRX2i51U8c z%G6nh{`WZj?*-_8t9I{JzpR2D@LL;tz%K`c{o?;aCqBgIY}%w_GGu)8KMXyIh8&rP z;SYVV?{&1dU^TPnQdeX9v-^SglHQRczhdL(p+Q3S?$D0DQ0HuOGcVJ@)Sg2*MAz zx8uLic!2=Ed;9w<4GaMPoeu;N5coTd7YyLLf9Jo>g+PA2EH5wo&kOVMLjE!NUekN{ z{yLc-{40d~g$CjS{t7*Rq4DyAA@{rbR~nQTa=%0Wp`rb1fsz<_kV#Z|p}hR}d-R{N z-z}&B=4Zj2;t-V`)l2A2;}c#fqdY9EDz*^{<77-s00Gv zZ_qz!|4<18=7-+%-6Q;Gj3EGlzv~Htfd7jTfT91y_`fX7$M+B1L45pwG6K4PS=GH! z{e3e){6IebBqA6xH5|mx19Nb=_sn~we&vtn_T~=spx>@?-;tu%p%;cqOUv+s`NhFf z{CpB1ey9Xg8Ym4C;FsW&;1lPENQh$p|FisZJ1GYfNlP;m8)sKLdLBt}87W=?Fh~Xj yfIxtfQUXvgpQH>>5^`^20BHai^vmg-U5uPuJedEx diff --git a/extra_script.py b/extra_script.py index 5a6c220..3f41463 100644 --- a/extra_script.py +++ b/extra_script.py @@ -10,7 +10,7 @@ from datetime import datetime import re import pprint from platformio.project.config import ProjectConfig -from platformio.project.exception import InvalidProjectConfError + Import("env") #print(env.Dump()) @@ -104,18 +104,7 @@ def writeFileIfChanged(fileName,data): return True def mergeConfig(base,other): - try: - customconfig = env.GetProjectOption("custom_config") - except InvalidProjectConfError: - customconfig = None - for bdir in other: - if customconfig and os.path.exists(os.path.join(bdir,customconfig)): - cname=os.path.join(bdir,customconfig) - print("merge custom config {}".format(cname)) - with open(cname,'rb') as ah: - base += json.load(ah) - continue - cname=os.path.join(bdir,"config.json") + for cname in other: if os.path.exists(cname): print("merge config %s"%cname) with open(cname,'rb') as ah: @@ -161,13 +150,25 @@ def expandConfig(config): rt.append(replaceTexts(c,replace)) return rt -def generateMergedConfig(inFile,outFile,addDirs=[]): +def createUserItemList(dirs,itemName,files): + rt=[] + for d in dirs: + iname=os.path.join(d,itemName) + if os.path.exists(iname): + rt.append(iname) + for f in files: + if not os.path.exists(f): + raise Exception("user item %s not found"%f) + rt.append(f) + return rt + +def generateMergedConfig(inFile,outFile,addFiles=[]): if not os.path.exists(inFile): raise Exception("unable to read cfg file %s"%inFile) data="" with open(inFile,'rb') as ch: config=json.load(ch) - config=mergeConfig(config,addDirs) + config=mergeConfig(config,addFiles) config=expandConfig(config) data=json.dumps(config,indent=2) writeFileIfChanged(outFile,data) @@ -205,11 +206,6 @@ def generateCfg(inFile,outFile,impl): secret="false"; if item.get('type') == 'password': secret="true" - """ - PSRAM Allocator TODO Tests - new (heap_caps_malloc(sizeof(GwConfigInterface), MALLOC_CAP_SPIRAM)) - """ - #data+=" new (heap_caps_malloc(sizeof(GwConfigInterface), MALLOC_CAP_SPIRAM)) GwConfigInterface(%s,\"%s\",%s);\n"%(name,item.get('default'),secret) data+=" new GwConfigInterface(%s,\"%s\",%s);\n"%(name,item.get('default'),secret) data+='}\n' writeFileIfChanged(outFile,data) @@ -392,12 +388,7 @@ def getLibs(): -def joinFiles(target,pattern,dirlist): - flist=[] - for dir in dirlist: - fn=os.path.join(dir,pattern) - if os.path.exists(fn): - flist.append(fn) +def joinFiles(target,flist): current=False if os.path.exists(target): current=True @@ -468,7 +459,28 @@ def handleDeps(env): ) env.AddBuildMiddleware(injectIncludes) +def getOption(env,name,toArray=True): + try: + opt=env.GetProjectOption(name) + if toArray: + if opt is None: + return [] + if isinstance(opt,list): + return opt + return opt.split("\n" if "\n" in opt else ",") + return opt + except: + pass + if toArray: + return [] +def getFileList(files): + base=basePath() + rt=[] + for f in files: + if f is not None and f != "": + rt.append(os.path.join(base,f)) + return rt def prebuild(env): global userTaskDirs print("#prebuild running") @@ -478,14 +490,18 @@ def prebuild(env): if ldf_mode == 'off': print("##ldf off - own dependency handling") handleDeps(env) + extraConfigs=getOption(env,'custom_config',toArray=True) + extraJs=getOption(env,'custom_js',toArray=True) + extraCss=getOption(env,'custom_css',toArray=True) + userTaskDirs=getUserTaskDirs() mergedConfig=os.path.join(outPath(),os.path.basename(CFG_FILE)) - generateMergedConfig(os.path.join(basePath(),CFG_FILE),mergedConfig,userTaskDirs) + generateMergedConfig(os.path.join(basePath(),CFG_FILE),mergedConfig,createUserItemList(userTaskDirs,"config.json", getFileList(extraConfigs))) compressFile(mergedConfig,mergedConfig+".gz") generateCfg(mergedConfig,os.path.join(outPath(),CFG_INCLUDE),False) generateCfg(mergedConfig,os.path.join(outPath(),CFG_INCLUDE_IMPL),True) - joinFiles(os.path.join(outPath(),INDEXJS+".gz"),INDEXJS,["web"]+userTaskDirs) - joinFiles(os.path.join(outPath(),INDEXCSS+".gz"),INDEXCSS,["web"]+userTaskDirs) + joinFiles(os.path.join(outPath(),INDEXJS+".gz"),createUserItemList(["web"]+userTaskDirs,INDEXJS,getFileList(extraJs))) + joinFiles(os.path.join(outPath(),INDEXCSS+".gz"),createUserItemList(["web"]+userTaskDirs,INDEXCSS,getFileList(extraCss))) embedded=getEmbeddedFiles(env) filedefs=[] for ef in embedded: @@ -506,12 +522,10 @@ def prebuild(env): genereateUserTasks(os.path.join(outPath(), TASK_INCLUDE)) generateFile(os.path.join(basePath(),XDR_FILE),os.path.join(outPath(),XDR_INCLUDE),generateXdrMappings) generateFile(os.path.join(basePath(),GROVE_CONFIG_IN),os.path.join(outPath(),GROVE_CONFIG),generateGroveDefs,inMode='r') - version = "dev{}{}".format(datetime.now().strftime("%Y%m%d"), "-ext") + version="dev"+datetime.now().strftime("%Y%m%d") env.Append(CPPDEFINES=[('GWDEVVERSION',version)]) def cleangenerated(source, target, env): - # TODO source / target order? - print("CLEAN: {} - {}".format(source, target)) od=outPath() if os.path.isdir(od): print("#cleaning up %s"%od) @@ -521,6 +535,7 @@ def cleangenerated(source, target, env): fn=os.path.join(od,f) os.unlink(f) + print("#prescript...") prebuild(env) board="PLATFORM_BOARD_%s"%env["BOARD"].replace("-","_").upper() @@ -532,17 +547,16 @@ env.Append( ) #script does not run on clean yet - maybe in the future env.AddPostAction("clean",cleangenerated) - -#look for extra task scripts and include them here -for taskdir in userTaskDirs: - script = os.path.join(taskdir, "extra_task.py") +extraScripts=getFileList(getOption(env,'custom_script',toArray=True)) +for script in extraScripts: if os.path.isfile(script): - taskname = os.path.basename(os.path.normpath(taskdir)) - print("#extra task script for '{}'".format(taskname)) + print(f"#extra {script}") with open(script) as fh: try: - code = compile(fh.read(), taskname, 'exec') - except SyntaxError: - print("#ERROR: script does not compile") + code = compile(fh.read(), script, 'exec') + except SyntaxError as e: + print(f"#ERROR: script {script} does not compile: {e}") continue exec(code) + else: + print(f"#ERROR: script {script} not found") diff --git a/lib/aisparser/ais_decoder.cpp b/lib/aisparser/ais_decoder.cpp index 6fece95..3c5dc00 100644 --- a/lib/aisparser/ais_decoder.cpp +++ b/lib/aisparser/ais_decoder.cpp @@ -627,7 +627,7 @@ void AisDecoder::decodeType21(PayloadBuffer &_buffer, unsigned int _uMsgType, in } // decode message fields (binary buffer has to go through all fields, but some fields are not used) - _buffer.getUnsignedValue(2); // repeatIndicator + auto repeat=_buffer.getUnsignedValue(2); // repeatIndicator auto mmsi = _buffer.getUnsignedValue(30); auto aidType = _buffer.getUnsignedValue(5); auto name = _buffer.getString(120); @@ -640,11 +640,11 @@ void AisDecoder::decodeType21(PayloadBuffer &_buffer, unsigned int _uMsgType, in auto toStarboard = _buffer.getUnsignedValue(6); _buffer.getUnsignedValue(4); // epfd type - _buffer.getUnsignedValue(6); // timestamp - _buffer.getBoolValue(); // off position + auto timestamp=_buffer.getUnsignedValue(6); // timestamp + auto offPosition=_buffer.getBoolValue(); // off position _buffer.getUnsignedValue(8); // reserved - _buffer.getBoolValue(); // RAIM - _buffer.getBoolValue(); // virtual aid + auto raim=_buffer.getBoolValue(); // RAIM + auto virtualAton=_buffer.getBoolValue(); // virtual aid _buffer.getBoolValue(); // assigned mode _buffer.getUnsignedValue(1); // spare @@ -654,7 +654,9 @@ void AisDecoder::decodeType21(PayloadBuffer &_buffer, unsigned int _uMsgType, in nameExt = _buffer.getString(88); } - onType21(mmsi, aidType, name + nameExt, posAccuracy, posLon, posLat, toBow, toStern, toPort, toStarboard); + onType21(mmsi, aidType, name + nameExt, posAccuracy, posLon, posLat, + toBow, toStern, toPort, toStarboard, + repeat,timestamp, raim, virtualAton, offPosition); } /* decode Voyage Report and Static Data (type nibble already pulled from buffer) */ diff --git a/lib/aisparser/ais_decoder.h b/lib/aisparser/ais_decoder.h index c908839..7872d3b 100644 --- a/lib/aisparser/ais_decoder.h +++ b/lib/aisparser/ais_decoder.h @@ -297,7 +297,8 @@ namespace AIS bool assigned, unsigned int repeat, bool raim) = 0; virtual void onType21(unsigned int _uMmsi, unsigned int _uAidType, const std::string &_strName, bool _bPosAccuracy, int _iPosLon, int _iPosLat, - unsigned int _uToBow, unsigned int _uToStern, unsigned int _uToPort, unsigned int _uToStarboard) = 0; + unsigned int _uToBow, unsigned int _uToStern, unsigned int _uToPort, unsigned int _uToStarboard, + unsigned int repeat,unsigned int timestamp, bool raim, bool virtualAton, bool offPosition) = 0; virtual void onType24A(unsigned int _uMsgType, unsigned int _repeat, unsigned int _uMmsi, const std::string &_strName) = 0; diff --git a/lib/api/GwApi.h b/lib/api/GwApi.h index 210519e..2397461 100644 --- a/lib/api/GwApi.h +++ b/lib/api/GwApi.h @@ -3,6 +3,7 @@ #include "GwMessage.h" #include "N2kMsg.h" #include "Nmea2kTwai.h" +#include "N2kDeviceList.h" #include "NMEA0183Msg.h" #include "GWConfig.h" #include "GwBoatData.h" @@ -225,6 +226,7 @@ class GwApi{ * you need to use the request pattern as shown in GwExampleTask.cpp */ virtual Nmea2kTwai *getNMEA2000()=0; + virtual tN2kDeviceList *getN2kDeviceList()=0; virtual GwBoatData *getBoatData()=0; virtual ~GwApi(){} }; diff --git a/lib/appinfo/GwAppInfo.h b/lib/appinfo/GwAppInfo.h index f7eb143..b6ab885 100644 --- a/lib/appinfo/GwAppInfo.h +++ b/lib/appinfo/GwAppInfo.h @@ -14,6 +14,9 @@ #define LOGLEVEL GwLog::DEBUG #endif #endif - +#ifdef GWBUILD_NAME +#define FIRMWARE_TYPE GWSTRINGIFY(GWBUILD_NAME) +#else #define FIRMWARE_TYPE GWSTRINGIFY(PIO_ENV_BUILD) -#define IDF_VERSION GWSTRINGIFY(ESP_IDF_VERSION_MAJOR) "." GWSTRINGIFY(ESP_IDF_VERSION_MINOR) "." GWSTRINGIFY(ESP_IDF_VERSION_PATCH) \ No newline at end of file +#endif +#define IDF_VERSION GWSTRINGIFY(ESP_IDF_VERSION_MAJOR) "." GWSTRINGIFY(ESP_IDF_VERSION_MINOR) "." GWSTRINGIFY(ESP_IDF_VERSION_PATCH) diff --git a/lib/channel/GwChannel.cpp b/lib/channel/GwChannel.cpp index 9c79983..1a0d06f 100644 --- a/lib/channel/GwChannel.cpp +++ b/lib/channel/GwChannel.cpp @@ -249,3 +249,16 @@ unsigned long GwChannel::countTx(){ if (! countOut) return 0UL; return countOut->getGlobal(); } +String GwChannel::typeString(int type){ + switch (type){ + case GWSERIAL_TYPE_UNI: + return "UNI"; + case GWSERIAL_TYPE_BI: + return "BI"; + case GWSERIAL_TYPE_RX: + return "RX"; + case GWSERIAL_TYPE_TX: + return "TX"; + } + return "UNKNOWN"; +} \ No newline at end of file diff --git a/lib/channel/GwChannel.h b/lib/channel/GwChannel.h index 66fb4ae..6b34432 100644 --- a/lib/channel/GwChannel.h +++ b/lib/channel/GwChannel.h @@ -77,7 +77,8 @@ class GwChannel{ if (maxSourceId < 0) return source == sourceId; return (source >= sourceId && source <= maxSourceId); } - String getMode(){return impl->getMode();} + static String typeString(int type); + String getMode(){return typeString(impl->getType());} int getMinId(){return sourceId;}; }; diff --git a/lib/channel/GwChannelInterface.h b/lib/channel/GwChannelInterface.h index 68f519b..30550d9 100644 --- a/lib/channel/GwChannelInterface.h +++ b/lib/channel/GwChannelInterface.h @@ -1,10 +1,11 @@ #pragma once #include "GwBuffer.h" +#include "GwChannelModes.h" class GwChannelInterface{ public: virtual void loop(bool handleRead,bool handleWrite)=0; virtual void readMessages(GwMessageFetcher *writer)=0; virtual size_t sendToClients(const char *buffer, int sourceId, bool partial=false)=0; virtual Stream * getStream(bool partialWrites){ return NULL;} - virtual String getMode(){return "UNKNOWN";} + virtual int getType(){ return GWSERIAL_TYPE_BI;} //return the numeric type }; \ No newline at end of file diff --git a/lib/channel/GwChannelList.cpp b/lib/channel/GwChannelList.cpp index c9db748..8a85863 100644 --- a/lib/channel/GwChannelList.cpp +++ b/lib/channel/GwChannelList.cpp @@ -15,8 +15,10 @@ class SerInit{ int tx=-1; int mode=-1; int fixedBaud=-1; - SerInit(int s,int r,int t, int m, int b=-1): - serial(s),rx(r),tx(t),mode(m),fixedBaud(b){} + int ena=-1; + int elow=1; + SerInit(int s,int r,int t, int m, int b=-1,int en=-1,int el=-1): + serial(s),rx(r),tx(t),mode(m),fixedBaud(b),ena(en),elow(el){} }; std::vector serialInits; @@ -47,11 +49,20 @@ static int typeFromMode(const char *mode){ #ifndef GWSERIAL_RX #define GWSERIAL_RX -1 #endif +#ifndef GWSERIAL_ENA +#define GWSERIAL_ENA -1 +#endif +#ifndef GWSERIAL_ELO +#define GWSERIAL_ELO 0 +#endif +#ifndef GWSERIAL_BAUD +#define GWSERIAL_BAUD -1 +#endif #ifdef GWSERIAL_TYPE - CFG_SERIAL(SERIAL1_CHANNEL_ID, GWSERIAL_RX, GWSERIAL_TX, GWSERIAL_TYPE) + CFG_SERIAL(SERIAL1_CHANNEL_ID, GWSERIAL_RX, GWSERIAL_TX, GWSERIAL_TYPE,GWSERIAL_BAUD,GWSERIAL_ENA,GWSERIAL_ELO) #else #ifdef GWSERIAL_MODE -CFG_SERIAL(SERIAL1_CHANNEL_ID, GWSERIAL_RX, GWSERIAL_TX, typeFromMode(GWSERIAL_MODE)) +CFG_SERIAL(SERIAL1_CHANNEL_ID, GWSERIAL_RX, GWSERIAL_TX, typeFromMode(GWSERIAL_MODE),GWSERIAL_BAUD,GWSERIAL_ENA,GWSERIAL_ELO) #endif #endif // serial 2 @@ -61,11 +72,20 @@ CFG_SERIAL(SERIAL1_CHANNEL_ID, GWSERIAL_RX, GWSERIAL_TX, typeFromMode(GWSERIAL_M #ifndef GWSERIAL2_RX #define GWSERIAL2_RX -1 #endif +#ifndef GWSERIAL2_ENA +#define GWSERIAL2_ENA -1 +#endif +#ifndef GWSERIAL2_ELO +#define GWSERIAL2_ELO 0 +#endif +#ifndef GWSERIAL2_BAUD +#define GWSERIAL2_BAUD -1 +#endif #ifdef GWSERIAL2_TYPE - CFG_SERIAL(SERIAL2_CHANNEL_ID, GWSERIAL2_RX, GWSERIAL2_TX, GWSERIAL2_TYPE) + CFG_SERIAL(SERIAL2_CHANNEL_ID, GWSERIAL2_RX, GWSERIAL2_TX, GWSERIAL2_TYPE,GWSERIAL2_BAUD,GWSERIAL2_ENA,GWSERIAL2_ELO) #else #ifdef GWSERIAL2_MODE -CFG_SERIAL(SERIAL2_CHANNEL_ID, GWSERIAL2_RX, GWSERIAL2_TX, typeFromMode(GWSERIAL2_MODE)) +CFG_SERIAL(SERIAL2_CHANNEL_ID, GWSERIAL2_RX, GWSERIAL2_TX, typeFromMode(GWSERIAL2_MODE),GWSERIAL2_BAUD,GWSERIAL2_ENA,GWSERIAL2_ELO) #endif #endif class GwSerialLog : public GwLogWriter @@ -285,8 +305,8 @@ static ChannelParam channelParameters[]={ }; template -GwSerial* createSerial(GwLog *logger, T* s,int id, bool canRead=true){ - return new GwSerialImpl(logger,s,id,canRead); +GwSerial* createSerial(GwLog *logger, T* s,int id, int type, bool canRead=true){ + return new GwSerialImpl(logger,s,id,type,canRead); } static ChannelParam * findChannelParam(int id){ @@ -300,7 +320,7 @@ static ChannelParam * findChannelParam(int id){ return param; } -static GwSerial * createSerialImpl(GwConfigHandler *config,GwLog *logger, int idx,int rx,int tx, bool setLog=false){ +static GwSerial * createSerialImpl(GwConfigHandler *config,GwLog *logger, int idx,int type,int rx,int tx, bool setLog,int ena=-1,int elow=1){ LOG_DEBUG(GwLog::DEBUG,"create serial: channel=%d, rx=%d,tx=%d", idx,rx,tx); ChannelParam *param=findChannelParam(idx); @@ -312,19 +332,45 @@ static GwSerial * createSerialImpl(GwConfigHandler *config,GwLog *logger, int id GwLog *streamLog=setLog?nullptr:logger; switch(param->id){ case USB_CHANNEL_ID: - serialStream=createSerial(streamLog,&USBSerial,param->id); + serialStream=createSerial(streamLog,&USBSerial,param->id,type); break; case SERIAL1_CHANNEL_ID: - serialStream=createSerial(streamLog,&Serial1,param->id); + serialStream=createSerial(streamLog,&Serial1,param->id,type); break; case SERIAL2_CHANNEL_ID: - serialStream=createSerial(streamLog,&Serial2,param->id); + serialStream=createSerial(streamLog,&Serial2,param->id,type); break; } if (serialStream == nullptr){ LOG_DEBUG(GwLog::ERROR,"invalid serial config with id %d",param->id); return nullptr; } + if (ena >= 0){ + int value=-1; + if (type == GWSERIAL_TYPE_UNI){ + String cfgMode=config->getString(param->direction); + if (cfgMode == "send"){ + value=elow?0:1; + } + else{ + value=elow?1:0; + } + } + if (type == GWSERIAL_TYPE_RX){ + value=elow?1:0; + } + if (type == GWSERIAL_TYPE_TX){ + value=elow?0:1; + } + if (value >= 0){ + LOG_DEBUG(GwLog::LOG,"serial %d: setting output enable %d to %d",param->id,ena,value); + pinMode(ena,OUTPUT); + digitalWrite(ena,value); + } + else{ + LOG_DEBUG(GwLog::ERROR,"serial %d: output enable ignored for mode %d",param->id, type); + } + } serialStream->begin(config->getInt(param->baud,115200),SERIAL_8N1,rx,tx); if (setLog){ logger->setWriter(new GwSerialLog(serialStream,config->getBool(param->preventLog,false))); @@ -332,12 +378,13 @@ static GwSerial * createSerialImpl(GwConfigHandler *config,GwLog *logger, int id } return serialStream; } -static GwChannel * createChannel(GwLog *logger, GwConfigHandler *config, int id,GwChannelInterface *impl, int type=GWSERIAL_TYPE_BI){ +static GwChannel * createChannel(GwLog *logger, GwConfigHandler *config, int id,GwChannelInterface *impl){ ChannelParam *param=findChannelParam(id); if (param == nullptr){ LOG_DEBUG(GwLog::ERROR,"invalid channel id %d",id); return nullptr; } + int type=impl->getType(); bool canRead=false; bool canWrite=false; bool validType=false; @@ -425,10 +472,10 @@ void GwChannelList::begin(bool fallbackSerial){ GwChannel *channel=NULL; //usb if (! fallbackSerial){ - GwSerial *usbSerial=createSerialImpl(config, logger,USB_CHANNEL_ID,GWUSB_RX,GWUSB_TX,true); + GwSerial *usbSerial=createSerialImpl(config, logger,USB_CHANNEL_ID,GWSERIAL_TYPE_BI,GWUSB_RX,GWUSB_TX,true); if (usbSerial != nullptr){ usbSerial->enableWriteLock(); //as it is used for logging we need this additionally - GwChannel *usbChannel=createChannel(logger,config,USB_CHANNEL_ID,usbSerial,GWSERIAL_TYPE_BI); + GwChannel *usbChannel=createChannel(logger,config,USB_CHANNEL_ID,usbSerial); if (usbChannel != nullptr){ addChannel(usbChannel); } @@ -444,10 +491,11 @@ void GwChannelList::begin(bool fallbackSerial){ //new serial config handling for (auto &&init:serialInits){ - LOG_INFO("creating serial channel %d, rx=%d,tx=%d,type=%d",init.serial,init.rx,init.tx,init.mode); - GwSerial *ser=createSerialImpl(config,logger,init.serial,init.rx,init.tx); + LOG_INFO("creating serial channel %d, rx=%d,tx=%d,type=%d fixedBaud=%d ena=%d elow=%d", + init.serial,init.rx,init.tx,init.mode,init.fixedBaud,init.ena,init.elow); + GwSerial *ser=createSerialImpl(config,logger,init.serial,init.mode,init.rx,init.tx,false,init.ena,init.elow); if (ser != nullptr){ - channel=createChannel(logger,config,init.serial,ser,init.mode); + channel=createChannel(logger,config,init.serial,ser); if (channel != nullptr){ addChannel(channel); } @@ -466,8 +514,8 @@ void GwChannelList::begin(bool fallbackSerial){ config->getInt(config->remotePort), config->getBool(config->readTCL) ); + addChannel(createChannel(logger,config,TCP_CLIENT_CHANNEL_ID,client)); } - addChannel(createChannel(logger,config,TCP_CLIENT_CHANNEL_ID,client)); //udp writer if (config->getBool(GwConfigDefinitions::udpwEnabled)){ diff --git a/lib/config/GwConverterConfig.h b/lib/config/GwConverterConfig.h index 4a93a71..46c66b5 100644 --- a/lib/config/GwConverterConfig.h +++ b/lib/config/GwConverterConfig.h @@ -3,7 +3,7 @@ This code 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 2.1 of the License, or (at your option) any later version. + version 2 of the License, or (at your option) any later version. This code 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 @@ -113,4 +113,4 @@ class GwConverterConfig{ }; -#endif \ No newline at end of file +#endif diff --git a/lib/exampletask/Readme.md b/lib/exampletask/Readme.md index 7637ecf..3220242 100644 --- a/lib/exampletask/Readme.md +++ b/lib/exampletask/Readme.md @@ -57,6 +57,44 @@ Files Starting from Version 20250305 you should normally not use this file name any more as those styles would be added for all build environments. Instead define a parameter _custom_css_ in your [platformio.ini](platformio.ini) for the environments you would like to add some styles for. This parameter accepts a list of file names (relative to the project root, separated by , or as multi line entry) + * [script.py](script.py)
+ Starting from version 20251007 you can define a parameter "custom_script" in your [platformio.ini](platformio.ini). + This parameter can contain a list of file names (relative to the project root) that will be added as a [platformio extra script](https://docs.platformio.org/en/latest/scripting/index.html#scripting). The scripts will be loaded at the end of the main [extra_script](../../extra_script.py). + You can add code there that is specific for your build. + Example: + ``` + # PlatformIO extra script for obp60task + epdtype = "unknown" + pcbvers = "unknown" + for x in env["BUILD_FLAGS"]: + if x.startswith("-D HARDWARE_"): + pcbvers = x.split('_')[1] + if x.startswith("-D DISPLAY_"): + epdtype = x.split('_')[1] + + propfilename = os.path.join(env["PROJECT_LIBDEPS_DIR"], env ["PIOENV"], "GxEPD2/library.properties") + properties = {} + with open(propfilename, 'r') as file: + for line in file: + match = re.match(r'^([^=]+)=(.*)$', line) + if match: + key = match.group(1).strip() + value = match.group(2).strip() + properties[key] = value + + gxepd2vers = "unknown" + try: + if properties["name"] == "GxEPD2": + gxepd2vers = properties["version"] + except: + pass + + env["CPPDEFINES"].extend([("BOARD", env["BOARD"]), ("EPDTYPE", epdtype), ("PCBVERS", pcbvers), ("GXEPD2VERS", gxepd2vers)]) + + print("added hardware info to CPPDEFINES") + print("friendly board name is '{}'".format(env.GetProjectOption ("board_name"))) + ``` + Interfaces ---------- diff --git a/lib/exampletask/platformio.ini b/lib/exampletask/platformio.ini index 348b36c..74363a9 100644 --- a/lib/exampletask/platformio.ini +++ b/lib/exampletask/platformio.ini @@ -14,5 +14,6 @@ custom_config= lib/exampletask/exampleConfig.json custom_js=lib/exampletask/example.js custom_css=lib/exampletask/example.css +custom_script=lib/exampletask/script.py upload_port = /dev/esp32 upload_protocol = esptool \ No newline at end of file diff --git a/lib/exampletask/script.py b/lib/exampletask/script.py new file mode 100644 index 0000000..fb53d6f --- /dev/null +++ b/lib/exampletask/script.py @@ -0,0 +1,4 @@ +Import("env") + +print("exampletask extra script running") +syntax error here \ No newline at end of file diff --git a/lib/gwwifi/GWWifi.h b/lib/gwwifi/GWWifi.h index 9063a4e..6457aef 100644 --- a/lib/gwwifi/GWWifi.h +++ b/lib/gwwifi/GWWifi.h @@ -2,6 +2,9 @@ #define _GWWIFI_H #include #include +#include +#include + class GwWifi{ private: const GwConfigHandler *config; @@ -16,15 +19,21 @@ class GwWifi{ bool apActive=false; bool fixedApPass=true; bool clientIsConnected=false; + SemaphoreHandle_t wifiMutex=nullptr; + static const TickType_t WIFI_MUTEX_TIMEOUT=pdMS_TO_TICKS(1000); + bool acquireMutex(); + void releaseMutex(); public: const char *AP_password = "esp32nmea2k"; GwWifi(const GwConfigHandler *config,GwLog *log, bool fixedApPass=true); + ~GwWifi(); void setup(); void loop(); bool clientConnected(); - bool connectClient(); + bool connectClient(); // Blocking version + bool connectClientAsync(); // Non-blocking version for other tasks String apIP(); bool isApActive(){return apActive;} bool isClientActive(){return wifiClient->asBoolean();} }; -#endif \ No newline at end of file +#endif diff --git a/lib/gwwifi/GwWifi.cpp b/lib/gwwifi/GwWifi.cpp index c81acec..bc51800 100644 --- a/lib/gwwifi/GwWifi.cpp +++ b/lib/gwwifi/GwWifi.cpp @@ -1,7 +1,6 @@ #include #include "GWWifi.h" - GwWifi::GwWifi(const GwConfigHandler *config,GwLog *log, bool fixedApPass){ this->config=config; this->logger=log; @@ -9,6 +8,28 @@ GwWifi::GwWifi(const GwConfigHandler *config,GwLog *log, bool fixedApPass){ wifiSSID=config->getConfigItem(config->wifiSSID,true); wifiPass=config->getConfigItem(config->wifiPass,true); this->fixedApPass=fixedApPass; + wifiMutex=xSemaphoreCreateMutex(); + if (wifiMutex==nullptr){ + LOG_DEBUG(GwLog::ERROR,"GwWifi: unable to create mutex"); + } +} + +GwWifi::~GwWifi(){ + if (wifiMutex!=nullptr){ + vSemaphoreDelete(wifiMutex); + wifiMutex=nullptr; + } +} + +bool GwWifi::acquireMutex(){ + if (wifiMutex==nullptr) return false; + return xSemaphoreTake(wifiMutex,WIFI_MUTEX_TIMEOUT)==pdTRUE; +} + +void GwWifi::releaseMutex(){ + if (wifiMutex!=nullptr){ + xSemaphoreGive(wifiMutex); + } } void GwWifi::setup(){ LOG_DEBUG(GwLog::LOG,"Wifi setup"); @@ -85,8 +106,14 @@ bool GwWifi::connectInternal(){ if (wifiClient->asBoolean()){ clientIsConnected=false; LOG_DEBUG(GwLog::LOG,"creating wifiClient ssid=%s",wifiSSID->asString().c_str()); + // CRITICAL SECTION: WiFi operations has to be serialized + if (!acquireMutex()){ + LOG_DEBUG(GwLog::ERROR,"GwWifi: mutex timeout in connectInternal"); + return false; + } WiFi.setAutoReconnect(false); //#102 wl_status_t rt=WiFi.begin(wifiSSID->asCString(),wifiPass->asCString()); + releaseMutex(); LOG_DEBUG(GwLog::LOG,"wifiClient connect returns %d",(int)rt); lastConnectStart=millis(); return true; @@ -104,8 +131,42 @@ void GwWifi::loop(){ if (lastConnectStart > now || (lastConnectStart + RETRY_MILLIS) < now) { LOG_DEBUG(GwLog::LOG,"wifiClient: retry connect to %s", wifiSSID->asCString()); - WiFi.disconnect(); - connectInternal(); + + // Keep locked sections short to avoid cross-core stalls/WDT. + if (acquireMutex()){ + WiFi.disconnect(true); + releaseMutex(); + } + else{ + LOG_DEBUG(GwLog::ERROR,"GwWifi: mutex timeout in loop (disconnect)"); + } + + delay(300); + + if (acquireMutex()){ + esp_err_t stopErr=esp_wifi_stop(); + releaseMutex(); + if (stopErr != ESP_OK){ + LOG_DEBUG(GwLog::ERROR,"GwWifi: esp_wifi_stop failed: %d",(int)stopErr); + } + } + else{ + LOG_DEBUG(GwLog::ERROR,"GwWifi: mutex timeout in loop (stop)"); + } + + delay(100); + + if (acquireMutex()){ + esp_err_t startErr=esp_wifi_start(); + releaseMutex(); + if (startErr != ESP_OK){ + LOG_DEBUG(GwLog::ERROR,"GwWifi: esp_wifi_start failed: %d",(int)startErr); + } + connectInternal(); + } + else{ + LOG_DEBUG(GwLog::ERROR,"GwWifi: mutex timeout in loop (start)"); + } } } else{ @@ -126,15 +187,46 @@ void GwWifi::loop(){ } } } + bool GwWifi::clientConnected(){ - return WiFi.status() == WL_CONNECTED; + // CRITICAL SECTION: WiFi.status() has to be protected + if (!acquireMutex()){ + LOG_DEBUG(GwLog::ERROR,"GwWifi: mutex timeout in clientConnected"); + return false; // conservative: assume not connected + } + bool result = WiFi.status() == WL_CONNECTED; + releaseMutex(); + return result; }; + bool GwWifi::connectClient(){ + // CRITICAL SECTION: disconnect and connect has to be atomar + if (!acquireMutex()){ + LOG_DEBUG(GwLog::ERROR,"GwWifi: mutex timeout in connectClient"); + return false; + } WiFi.disconnect(); + releaseMutex(); + return connectInternal(); +} + +bool GwWifi::connectClientAsync(){ + // Non-blocking version: Try to get Mutex but give up immediately + // Ideal for tasks which should not block + if (wifiMutex==nullptr){ + LOG_DEBUG(GwLog::ERROR,"GwWifi: mutex not initialized in connectClientAsync"); + return false; + } + if (xSemaphoreTake(wifiMutex, 0)!=pdTRUE){ + LOG_DEBUG(GwLog::LOG,"GwWifi: connectClientAsync skipped - WiFi busy"); + return false; // WiFiis busy, try again later + } + WiFi.disconnect(); + xSemaphoreGive(wifiMutex); return connectInternal(); } String GwWifi::apIP(){ if (! apActive) return String(); return WiFi.softAPIP().toString(); -} \ No newline at end of file +} diff --git a/lib/hardware/GwChannelModes.h b/lib/hardware/GwChannelModes.h new file mode 100644 index 0000000..e6c42de --- /dev/null +++ b/lib/hardware/GwChannelModes.h @@ -0,0 +1,23 @@ +/* + This code 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 2 of the License, or (at your option) any later version. + This code 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 + Lesser General Public License for more details. + You should have received a copy of the GNU Lesser General Public + License along with this library; if not, write to the Free Software + Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA + + defines for the channel modes(types) +*/ +#ifndef _GWCHANNELMODES_H +#define _GWCHANNELMODES_H +#define GWSERIAL_TYPE_UNI 1 +#define GWSERIAL_TYPE_BI 2 +#define GWSERIAL_TYPE_RX 3 +#define GWSERIAL_TYPE_TX 4 +#define GWSERIAL_TYPE_UNK 0 +#endif \ No newline at end of file diff --git a/lib/hardware/GwHardware.h b/lib/hardware/GwHardware.h index 0b14ab3..10a7404 100644 --- a/lib/hardware/GwHardware.h +++ b/lib/hardware/GwHardware.h @@ -2,7 +2,7 @@ This code 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 2.1 of the License, or (at your option) any later version. + version 2 of the License, or (at your option) any later version. This code 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 @@ -20,11 +20,7 @@ #endif #ifndef _GWHARDWARE_H #define _GWHARDWARE_H -#define GWSERIAL_TYPE_UNI 1 -#define GWSERIAL_TYPE_BI 2 -#define GWSERIAL_TYPE_RX 3 -#define GWSERIAL_TYPE_TX 4 -#define GWSERIAL_TYPE_UNK 0 +#include "GwChannelModes.h" #include #include #include "GwAppInfo.h" diff --git a/lib/hardware/GwM5Base.h b/lib/hardware/GwM5Base.h index a3284ee..67c865e 100644 --- a/lib/hardware/GwM5Base.h +++ b/lib/hardware/GwM5Base.h @@ -2,7 +2,7 @@ This code 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 2.1 of the License, or (at your option) any later version. + version 2 of the License, or (at your option) any later version. This code 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 @@ -35,7 +35,12 @@ #ifdef M5_GPS_KIT GWRESOURCE_USE(BASE,M5_GPS_KIT) GWRESOURCE_USE(SERIAL1,M5_GPS_KIT) - #define _GWI_SERIAL1 BOARD_LEFT1,-1,GWSERIAL_TYPE_UNI,9600 + #define _GWI_SERIAL1 BOARD_LEFT1,-1,GWSERIAL_TYPE_RX,9600 +#endif +#ifdef M5_GPSV2_KIT + GWRESOURCE_USE(BASE,M5_GPSV2_KIT) + GWRESOURCE_USE(SERIAL1,M5_GPSV2_KIT) + #define _GWI_SERIAL1 BOARD_LEFT1,-1,GWSERIAL_TYPE_RX,115200 #endif //M5 ProtoHub @@ -61,11 +66,11 @@ #endif //can kit for M5 Atom -#ifdef M5_CAN_KIT +#if defined (M5_CAN_KIT) GWRESOURCE_USE(BASE,M5_CAN_KIT) GWRESOURCE_USE(CAN,M5_CANKIT) #define ESP32_CAN_TX_PIN BOARD_LEFT1 #define ESP32_CAN_RX_PIN BOARD_LEFT2 #endif -#endif \ No newline at end of file +#endif diff --git a/lib/hardware/GwM5Grove.h b/lib/hardware/GwM5Grove.h index 220ee01..44761a1 100644 --- a/lib/hardware/GwM5Grove.h +++ b/lib/hardware/GwM5Grove.h @@ -2,7 +2,7 @@ This code 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 2.1 of the License, or (at your option) any later version. + version 2 of the License, or (at your option) any later version. This code 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 diff --git a/lib/hardware/GwM5Grove.in b/lib/hardware/GwM5Grove.in index aed70a1..a3c8c06 100644 --- a/lib/hardware/GwM5Grove.in +++ b/lib/hardware/GwM5Grove.in @@ -2,7 +2,7 @@ This code 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 2.1 of the License, or (at your option) any later version. + version 2 of the License, or (at your option) any later version. This code 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 @@ -43,6 +43,13 @@ #define _GWI_SERIAL_GROOVE$GS$ GWSERIAL_TYPE_RX,9600 #endif +#GROVE +//https://docs.m5stack.com/en/unit/Unit-GPS%20v1.1 +#ifdef M5_GPSV11_UNIT$GS$ + GWRESOURCE_USE(GROOVE$G$,M5_GPSV11_UNIT$GS$) + #define _GWI_SERIAL_GROOVE$GS$ GWSERIAL_TYPE_RX,115200 +#endif + #GROVE //CAN via groove #ifdef M5_CANUNIT$GS$ @@ -64,15 +71,15 @@ #endif #GROVE -//#ifdef M5_ENV4$GS$ -// #ifndef M5_GROOVEIIC$GS$ -// #define M5_GROOVEIIC$GS$ -// #endif -// GROOVE_IIC(SHT3X,$Z$,1) -// GROOVE_IIC(BMP280,$Z$,1) -// #define _GWSHT3X -// #define _GWBMP280 -//#endif +#ifdef M5_ENV4$GS$ + #ifndef M5_GROOVEIIC$GS$ + #define M5_GROOVEIIC$GS$ + #endif + GROOVE_IIC(SHT4X,$Z$,1) + GROOVE_IIC(BMP280,$Z$,1) + #define _GWSHT4X + #define _GWBMP280 +#endif #GROVE //example: -DSHT3XG1_A : defines STH3Xn1 on grove A - x depends on the other devices @@ -93,6 +100,25 @@ #define _GWSHT3X #endif +#GROVE +//example: -DSHT4XG1_A : defines STH4Xn1 on grove A - x depends on the other devices +#ifdef GWSHT4XG1$GS$ + #ifndef M5_GROOVEIIC$GS$ + #define M5_GROOVEIIC$GS$ + #endif + GROOVE_IIC(SHT4X,$Z$,1) + #define _GWSHT4X +#endif + +#GROVE +#ifdef GWSHT4XG2$GS$ + #ifndef M5_GROOVEIIC$GS$ + #define M5_GROOVEIIC$GS$ + #endif + GROOVE_IIC(SHT4X,$Z$,2) + #define _GWSHT4X +#endif + #GROVE #ifdef GWQMP6988G1$GS$ #ifndef M5_GROOVEIIC$GS$ diff --git a/lib/iictask/GwBME280.cpp b/lib/iictask/GwBME280.cpp index 1bf541f..177a775 100644 --- a/lib/iictask/GwBME280.cpp +++ b/lib/iictask/GwBME280.cpp @@ -23,6 +23,7 @@ class BME280Config : public IICSensorBase{ bool prAct=true; bool tmAct=true; bool huAct=true; + bool sEnv=true; tN2kTempSource tmSrc=tN2kTempSource::N2kts_InsideTemperature; tN2kHumiditySource huSrc=tN2kHumiditySource::N2khs_InsideHumidity; tN2kPressureSource prSrc=tN2kPressureSource::N2kps_Atmospheric; @@ -152,6 +153,7 @@ SensorBase::Creator registerBME280(GwApi *api){ CFG_SGET(s, prNam, prefix); \ CFG_SGET(s, tmOff, prefix); \ CFG_SGET(s, prOff, prefix); \ + CFG_SGET(s, sEnv, prefix); \ s->busId = bus; \ s->addr = baddr; \ s->ok = true; \ diff --git a/lib/iictask/GwBMP280.cpp b/lib/iictask/GwBMP280.cpp index e51bd4b..bee51e4 100644 --- a/lib/iictask/GwBMP280.cpp +++ b/lib/iictask/GwBMP280.cpp @@ -29,6 +29,7 @@ class BMP280Config : public IICSensorBase{ public: bool prAct=true; bool tmAct=true; + bool sEnv=true; tN2kTempSource tmSrc=tN2kTempSource::N2kts_InsideTemperature; tN2kPressureSource prSrc=tN2kPressureSource::N2kps_Atmospheric; tN2kHumiditySource huSrc=tN2kHumiditySource::N2khs_Undef; @@ -150,6 +151,7 @@ SensorBase::Creator registerBMP280(GwApi *api){ CFG_SGET(s, prNam, prefix); \ CFG_SGET(s, tmOff, prefix); \ CFG_SGET(s, prOff, prefix); \ + CFG_SGET(s, sEnv,prefix); \ s->busId = bus; \ s->addr = baddr; \ s->ok = true; \ diff --git a/lib/iictask/GwIicSensors.h b/lib/iictask/GwIicSensors.h index 4937daa..49fe2fe 100644 --- a/lib/iictask/GwIicSensors.h +++ b/lib/iictask/GwIicSensors.h @@ -104,12 +104,19 @@ void sendN2kTemperature(GwApi *api,CFG &cfg,double value, int counterId){ template void sendN2kEnvironmentalParameters(GwApi *api,CFG &cfg,double tmValue, double huValue, double prValue, int counterId){ + if (! cfg.sEnv) return; tN2kMsg msg; SetN2kEnvironmentalParameters(msg,1,cfg.tmSrc,tmValue,cfg.huSrc,huValue,prValue); api->sendN2kMessage(msg); - api->increment(counterId,cfg.prefix+String("hum")); - api->increment(counterId,cfg.prefix+String("press")); - api->increment(counterId,cfg.prefix+String("temp")); + if (huValue != N2kDoubleNA){ + api->increment(counterId,cfg.prefix+String("ehum")); + } + if (prValue != N2kDoubleNA){ + api->increment(counterId,cfg.prefix+String("epress")); + } + if (tmValue != N2kDoubleNA){ + api->increment(counterId,cfg.prefix+String("etemp")); + } } #ifndef _GWI_IIC1 diff --git a/lib/iictask/GwIicTask.cpp b/lib/iictask/GwIicTask.cpp index 221a420..998e441 100644 --- a/lib/iictask/GwIicTask.cpp +++ b/lib/iictask/GwIicTask.cpp @@ -23,7 +23,7 @@ static std::vector iicGroveList; #include "GwBME280.h" #include "GwBMP280.h" #include "GwQMP6988.h" -#include "GwSHT3X.h" +#include "GwSHTXX.h" #include #include "GwTimer.h" @@ -91,6 +91,7 @@ void initIicTask(GwApi *api){ GwConfigHandler *config=api->getConfig(); std::vector creators; creators.push_back(registerSHT3X(api)); + creators.push_back(registerSHT4X(api)); creators.push_back(registerQMP6988(api)); creators.push_back(registerBME280(api)); creators.push_back(registerBMP280(api)); @@ -147,13 +148,13 @@ bool initWire(GwLog *logger, TwoWire &wire, int num){ #ifdef _GWI_IIC1 return initWireDo(logger,wire,num,_GWI_IIC1); #endif - return initWireDo(logger,wire,num,"",GWIIC_SDA,GWIIC_SCL); + return initWireDo(logger,wire,num,"",GWIIC_SCL,GWIIC_SDA); } if (num == 2){ #ifdef _GWI_IIC2 return initWireDo(logger,wire,num,_GWI_IIC2); #endif - return initWireDo(logger,wire,num,"",GWIIC_SDA2,GWIIC_SCL2); + return initWireDo(logger,wire,num,"",GWIIC_SCL2,GWIIC_SDA2); } return false; } diff --git a/lib/iictask/GwQMP6988.cpp b/lib/iictask/GwQMP6988.cpp index 4f2b78c..a173980 100644 --- a/lib/iictask/GwQMP6988.cpp +++ b/lib/iictask/GwQMP6988.cpp @@ -9,6 +9,9 @@ class QMP6988Config : public IICSensorBase{ public: String prNam="Pressure"; bool prAct=true; + bool sEnv=true; + tN2kTempSource tmSrc=tN2kTempSource::N2kts_InsideTemperature; + tN2kHumiditySource huSrc=tN2kHumiditySource::N2khs_Undef; tN2kPressureSource prSrc=tN2kPressureSource::N2kps_Atmospheric; float prOff=0; QMP6988 *device=nullptr; @@ -39,6 +42,7 @@ class QMP6988Config : public IICSensorBase{ float computed=pressure+prOff; LOG_DEBUG(GwLog::DEBUG,"%s measure %2.0fPa, computed %2.0fPa",prefix.c_str(), pressure,computed); sendN2kPressure(api,*this,computed,counterId); + sendN2kEnvironmentalParameters(api,*this,N2kDoubleNA,N2kDoubleNA,computed,counterId); } @@ -90,6 +94,7 @@ SensorBase::Creator registerQMP6988(GwApi *api){ CFG_SGET(s,prAct,prefix); \ CFG_SGET(s,intv,prefix); \ CFG_SGET(s,prOff,prefix); \ + CFG_SGET(s,sEnv,prefix); \ s->busId = bus; \ s->addr = baddr; \ s->ok = true; \ @@ -108,4 +113,4 @@ SC6988(QMP698822,2,112); SensorBase::Creator registerQMP6988(GwApi *api){ return SensorBase::Creator(); } -#endif \ No newline at end of file +#endif diff --git a/lib/iictask/GwSHT3X.cpp b/lib/iictask/GwSHT3X.cpp deleted file mode 100644 index c93486f..0000000 --- a/lib/iictask/GwSHT3X.cpp +++ /dev/null @@ -1,138 +0,0 @@ -#include "GwSHT3X.h" -#ifdef _GWSHT3X -class SHT3XConfig; -static GwSensorConfigInitializerList configs; -class SHT3XConfig : public IICSensorBase{ - public: - String tmNam; - String huNam; - bool tmAct=false; - bool huAct=false; - tN2kHumiditySource huSrc; - tN2kTempSource tmSrc; - SHT3X *device=nullptr; - using IICSensorBase::IICSensorBase; - virtual bool isActive(){ - return tmAct || huAct; - } - virtual bool initDevice(GwApi * api,TwoWire *wire){ - if (! isActive()) return false; - device=new SHT3X(); - device->init(addr,wire); - GwLog *logger=api->getLogger(); - LOG_DEBUG(GwLog::LOG,"initialized %s at address %d, intv %ld",prefix.c_str(),(int)addr,intv); - return true; - } - virtual bool preinit(GwApi * api){ - GwLog *logger=api->getLogger(); - LOG_DEBUG(GwLog::LOG,"%s configured",prefix.c_str()); - addHumidXdr(api,*this); - addTempXdr(api,*this); - return isActive(); - } - virtual void measure(GwApi * api,TwoWire *wire, int counterId) - { - if (!device) - return; - GwLog *logger=api->getLogger(); - int rt = 0; - if ((rt = device->get()) == 0) - { - double temp = device->cTemp; - temp = CToKelvin(temp); - double humid = device->humidity; - LOG_DEBUG(GwLog::DEBUG, "%s measure temp=%2.1f, humid=%2.0f",prefix.c_str(), (float)temp, (float)humid); - if (huAct) - { - sendN2kHumidity(api, *this, humid, counterId); - } - if (tmAct) - { - sendN2kTemperature(api, *this, temp, counterId); - } - } - else - { - LOG_DEBUG(GwLog::DEBUG, "unable to query %s: %d",prefix.c_str(), rt); - } - } - - virtual void readConfig(GwConfigHandler *cfg){ - if (ok) return; - configs.readConfig(this,cfg); - return; - } -}; -SensorBase::Creator creator=[](GwApi *api,const String &prfx)-> SensorBase*{ - if (! configs.knowsPrefix(prfx)) return nullptr; - return new SHT3XConfig(api,prfx); -}; -SensorBase::Creator registerSHT3X(GwApi *api){ - GwLog *logger=api->getLogger(); - #if defined(GWSHT3X) || defined (GWSHT3X11) - { - api->addSensor(creator(api,"SHT3X11")); - CHECK_IIC1(); - #pragma message "GWSHT3X11 defined" - } - #endif - #if defined(GWSHT3X12) - { - api->addSensor(creator(api,"SHT3X12")); - CHECK_IIC1(); - #pragma message "GWSHT3X12 defined" - } - #endif - #if defined(GWSHT3X21) - { - api->addSensor(creator(api,"SHT3X21")); - CHECK_IIC2(); - #pragma message "GWSHT3X21 defined" - } - #endif - #if defined(GWSHT3X22) - { - api->addSensor(creator(api,"SHT3X22")); - CHECK_IIC2(); - #pragma message "GWSHT3X22 defined" - } - #endif - return creator; -}; - -/** - * we do not dynamically compute the config names - * just to get compile time errors if something does not fit - * correctly - */ -#define CFGSHT3X(s, prefix, bus, baddr) \ - CFG_SGET(s, tmNam, prefix); \ - CFG_SGET(s, huNam, prefix); \ - CFG_SGET(s, iid, prefix); \ - CFG_SGET(s, tmAct, prefix); \ - CFG_SGET(s, huAct, prefix); \ - CFG_SGET(s, intv, prefix); \ - CFG_SGET(s, huSrc, prefix); \ - CFG_SGET(s, tmSrc, prefix); \ - s->busId = bus; \ - s->addr = baddr; \ - s->ok = true; \ - s->intv *= 1000; - -#define SCSHT3X(prefix, bus, addr) \ - GWSENSORDEF(configs, SHT3XConfig, CFGSHT3X, prefix, bus, addr) - -SCSHT3X(SHT3X11, 1, 0x44); -SCSHT3X(SHT3X12, 1, 0x45); -SCSHT3X(SHT3X21, 2, 0x44); -SCSHT3X(SHT3X22, 2, 0x45); - -#else -SensorBase::Creator registerSHT3X(GwApi *api){ - return SensorBase::Creator(); -} - -#endif - - - diff --git a/lib/iictask/GwSHTXX.cpp b/lib/iictask/GwSHTXX.cpp new file mode 100644 index 0000000..0cfcca7 --- /dev/null +++ b/lib/iictask/GwSHTXX.cpp @@ -0,0 +1,254 @@ +#include "GwSHTXX.h" +#if defined(_GWSHT3X) || defined(_GWSHT4X) +class SHTXXConfig : public IICSensorBase{ + public: + String tmNam; + String huNam; + bool tmAct=false; + bool huAct=false; + bool sEnv=true; + tN2kHumiditySource huSrc; + tN2kTempSource tmSrc; + using IICSensorBase::IICSensorBase; + virtual bool isActive(){ + return tmAct || huAct; + } + virtual bool preinit(GwApi * api){ + GwLog *logger=api->getLogger(); + LOG_DEBUG(GwLog::LOG,"%s configured",prefix.c_str()); + addHumidXdr(api,*this); + addTempXdr(api,*this); + return isActive(); + } + virtual bool doMeasure(GwApi * api,double &temp, double &humid){ + return false; + } + virtual void measure(GwApi * api,TwoWire *wire, int counterId) override + { + GwLog *logger=api->getLogger(); + double temp = N2kDoubleNA; + double humid = N2kDoubleNA; + if (doMeasure(api,temp,humid)){ + temp = CToKelvin(temp); + LOG_DEBUG(GwLog::DEBUG, "%s measure temp=%2.1f, humid=%2.0f",prefix.c_str(), (float)temp, (float)humid); + if (huAct) + { + sendN2kHumidity(api, *this, humid, counterId); + } + if (tmAct) + { + sendN2kTemperature(api, *this, temp, counterId); + } + if (huAct || tmAct){ + sendN2kEnvironmentalParameters(api,*this,temp,humid,N2kDoubleNA,counterId); + } + } + } + +}; +/** + * we do not dynamically compute the config names + * just to get compile time errors if something does not fit + * correctly + */ +#define INITSHTXX(type,prefix,bus,baddr) \ +[] (type *s ,GwConfigHandler *cfg) { \ + CFG_SGET(s, tmNam, prefix); \ + CFG_SGET(s, huNam, prefix); \ + CFG_SGET(s, iid, prefix); \ + CFG_SGET(s, tmAct, prefix); \ + CFG_SGET(s, huAct, prefix); \ + CFG_SGET(s, intv, prefix); \ + CFG_SGET(s, huSrc, prefix); \ + CFG_SGET(s, tmSrc, prefix); \ + CFG_SGET(s, sEnv,prefix); \ + s->busId = bus; \ + s->addr = baddr; \ + s->ok = true; \ + s->intv *= 1000; \ +} + +#if defined(_GWSHT3X) +class SHT3XConfig; +static GwSensorConfigInitializerList configs3; +class SHT3XConfig : public SHTXXConfig{ + SHT3X *device=nullptr; + public: + using SHTXXConfig::SHTXXConfig; + virtual bool initDevice(GwApi * api,TwoWire *wire)override{ + if (! isActive()) return false; + device=new SHT3X(); + device->init(addr,wire); + GwLog *logger=api->getLogger(); + LOG_DEBUG(GwLog::LOG,"initialized %s at address %d, intv %ld",prefix.c_str(),(int)addr,intv); + return true; + } + virtual bool doMeasure(GwApi *api,double &temp, double &humid) override{ + if (!device) + return false; + int rt=0; + GwLog *logger=api->getLogger(); + if ((rt = device->get()) == 0) + { + temp = device->cTemp; + humid = device->humidity; + return true; + } + else{ + LOG_DEBUG(GwLog::DEBUG, "unable to query %s: %d",prefix.c_str(), rt); + } + return false; + } + virtual void readConfig(GwConfigHandler *cfg) override{ + if (ok) return; + configs3.readConfig(this,cfg); + return; + } +}; + +SensorBase::Creator creator3=[](GwApi *api,const String &prfx)-> SensorBase*{ + if (! configs3.knowsPrefix(prfx)) return nullptr; + return new SHT3XConfig(api,prfx); + }; +SensorBase::Creator registerSHT3X(GwApi *api){ + GwLog *logger=api->getLogger(); + #if defined(GWSHT3X) || defined (GWSHT3X11) + { + api->addSensor(creator3(api,"SHT3X11")); + CHECK_IIC1(); + #pragma message "GWSHT3X11 defined" + } + #endif + #if defined(GWSHT3X12) + { + api->addSensor(creator3(api,"SHT3X12")); + CHECK_IIC1(); + #pragma message "GWSHT3X12 defined" + } + #endif + #if defined(GWSHT3X21) + { + api->addSensor(creator3(api,"SHT3X21")); + CHECK_IIC2(); + #pragma message "GWSHT3X21 defined" + } + #endif + #if defined(GWSHT3X22) + { + api->addSensor(creator3(api,"SHT3X22")); + CHECK_IIC2(); + #pragma message "GWSHT3X22 defined" + } + #endif + return creator3; +}; + + +#define SCSHT3X(prefix, bus, addr) \ + GwSensorConfigInitializer __initCFGSHT3X ## prefix \ + (configs3,GwSensorConfig(#prefix,INITSHTXX(SHT3XConfig,prefix,bus,addr))); + +SCSHT3X(SHT3X11, 1, 0x44); +SCSHT3X(SHT3X12, 1, 0x45); +SCSHT3X(SHT3X21, 2, 0x44); +SCSHT3X(SHT3X22, 2, 0x45); + +#endif +#if defined(_GWSHT4X) +class SHT4XConfig; +static GwSensorConfigInitializerList configs4; +class SHT4XConfig : public SHTXXConfig{ + SHT4X *device=nullptr; + public: + using SHTXXConfig::SHTXXConfig; + virtual bool initDevice(GwApi * api,TwoWire *wire)override{ + if (! isActive()) return false; + device=new SHT4X(); + device->begin(wire,addr); + GwLog *logger=api->getLogger(); + LOG_DEBUG(GwLog::LOG,"initialized %s at address %d, intv %ld",prefix.c_str(),(int)addr,intv); + return true; + } + virtual bool doMeasure(GwApi *api,double &temp, double &humid) override{ + if (!device) + return false; + GwLog *logger=api->getLogger(); + if (device->update()) + { + temp = device->cTemp; + humid = device->humidity; + return true; + } + else{ + LOG_DEBUG(GwLog::DEBUG, "unable to query %s",prefix.c_str()); + } + return false; + } + virtual void readConfig(GwConfigHandler *cfg) override{ + if (ok) return; + configs4.readConfig(this,cfg); + return; + } +}; + +SensorBase::Creator creator4=[](GwApi *api,const String &prfx)-> SensorBase*{ + if (! configs4.knowsPrefix(prfx)) return nullptr; + return new SHT4XConfig(api,prfx); + }; +SensorBase::Creator registerSHT4X(GwApi *api){ + GwLog *logger=api->getLogger(); + #if defined(GWSHT4X) || defined (GWSHT4X11) + { + api->addSensor(creator3(api,"SHT4X11")); + CHECK_IIC1(); + #pragma message "GWSHT4X11 defined" + } + #endif + #if defined(GWSHT4X12) + { + api->addSensor(creator3(api,"SHT4X12")); + CHECK_IIC1(); + #pragma message "GWSHT4X12 defined" + } + #endif + #if defined(GWSHT4X21) + { + api->addSensor(creator3(api,"SHT4X21")); + CHECK_IIC2(); + #pragma message "GWSHT4X21 defined" + } + #endif + #if defined(GWSHT4X22) + { + api->addSensor(creator3(api,"SHT4X22")); + CHECK_IIC2(); + #pragma message "GWSHT4X22 defined" + } + #endif + return creator4; +}; + + +#define SCSHT4X(prefix, bus, addr) \ + GwSensorConfigInitializer __initCFGSHT4X ## prefix \ + (configs4,GwSensorConfig(#prefix,INITSHTXX(SHT4XConfig,prefix,bus,addr))); + +SCSHT4X(SHT4X11, 1, 0x44); +SCSHT4X(SHT4X12, 1, 0x45); +SCSHT4X(SHT4X21, 2, 0x44); +SCSHT4X(SHT4X22, 2, 0x45); +#endif +#endif +#ifndef _GWSHT3X +SensorBase::Creator registerSHT3X(GwApi *api){ + return SensorBase::Creator(); +} +#endif +#ifndef _GWSHT4X +SensorBase::Creator registerSHT4X(GwApi *api){ + return SensorBase::Creator(); +} +#endif + + + diff --git a/lib/iictask/GwSHT3X.h b/lib/iictask/GwSHTXX.h similarity index 50% rename from lib/iictask/GwSHT3X.h rename to lib/iictask/GwSHTXX.h index 6a5dfcf..52829b9 100644 --- a/lib/iictask/GwSHT3X.h +++ b/lib/iictask/GwSHTXX.h @@ -1,10 +1,13 @@ -#ifndef _GWSHT3X_H -#define _GWSHT3X_H +#ifndef _GWSHTXX_H +#define _GWSHTXX_H #include "GwIicSensors.h" #ifdef _GWIIC #if defined(GWSHT3X) || defined(GWSHT3X11) || defined(GWSHT3X12) || defined(GWSHT3X21) || defined(GWSHT3X22) #define _GWSHT3X #endif + #if defined(GWSHT4X) || defined(GWSHT4X11) || defined(GWSHT4X12) || defined(GWSHT4X21) || defined(GWSHT4X22) + #define _GWSHT4X + #endif #else #undef _GWSHT3X #undef GWSHT3X @@ -12,9 +15,19 @@ #undef GWSHT3X12 #undef GWSHT3X21 #undef GWSHT3X22 + #undef _GWSHT4X + #undef GWSHT4X + #undef GWSHT4X11 + #undef GWSHT4X12 + #undef GWSHT4X21 + #undef GWSHT4X22 #endif #ifdef _GWSHT3X #include "SHT3X.h" #endif +#ifdef _GWSHT4X + #include "SHT4X.h" +#endif SensorBase::Creator registerSHT3X(GwApi *api); +SensorBase::Creator registerSHT4X(GwApi *api); #endif \ No newline at end of file diff --git a/lib/iictask/SHT3X.cpp b/lib/iictask/SHT3X.cpp index 7830cf5..95c83f3 100644 --- a/lib/iictask/SHT3X.cpp +++ b/lib/iictask/SHT3X.cpp @@ -1,4 +1,4 @@ -#include "GwSHT3X.h" +#include "GwSHTXX.h" #ifdef _GWSHT3X bool SHT3X::init(uint8_t slave_addr_in, TwoWire* wire_in) @@ -44,4 +44,4 @@ byte SHT3X::get() return 0; } -#endif \ No newline at end of file +#endif diff --git a/lib/iictask/SHT4X.cpp b/lib/iictask/SHT4X.cpp new file mode 100644 index 0000000..6d14473 --- /dev/null +++ b/lib/iictask/SHT4X.cpp @@ -0,0 +1,131 @@ +#include "GwSHTXX.h" +#ifdef _GWSHT4X + +uint8_t crc8(const uint8_t *data, int len) { + /* + * + * CRC-8 formula from page 14 of SHT spec pdf + * + * Test data 0xBE, 0xEF should yield 0x92 + * + * Initialization data 0xFF + * Polynomial 0x31 (x8 + x5 +x4 +1) + * Final XOR 0x00 + */ + + const uint8_t POLYNOMIAL(0x31); + uint8_t crc(0xFF); + + for (int j = len; j; --j) { + crc ^= *data++; + + for (int i = 8; i; --i) { + crc = (crc & 0x80) ? (crc << 1) ^ POLYNOMIAL : (crc << 1); + } + } + return crc; +} + +bool SHT4X::begin(TwoWire* wire, uint8_t addr) { + _addr = addr; + _wire = wire; + int error; + _wire->beginTransmission(addr); + error = _wire->endTransmission(); + if (error == 0) { + return true; + } + return false; +} + +bool SHT4X::update() { + uint8_t readbuffer[6]; + uint8_t cmd = SHT4x_NOHEAT_HIGHPRECISION; + uint16_t duration = 10; + + if (_heater == SHT4X_NO_HEATER) { + if (_precision == SHT4X_HIGH_PRECISION) { + cmd = SHT4x_NOHEAT_HIGHPRECISION; + duration = 10; + } + if (_precision == SHT4X_MED_PRECISION) { + cmd = SHT4x_NOHEAT_MEDPRECISION; + duration = 5; + } + if (_precision == SHT4X_LOW_PRECISION) { + cmd = SHT4x_NOHEAT_LOWPRECISION; + duration = 2; + } + } + + if (_heater == SHT4X_HIGH_HEATER_1S) { + cmd = SHT4x_HIGHHEAT_1S; + duration = 1100; + } + if (_heater == SHT4X_HIGH_HEATER_100MS) { + cmd = SHT4x_HIGHHEAT_100MS; + duration = 110; + } + + if (_heater == SHT4X_MED_HEATER_1S) { + cmd = SHT4x_MEDHEAT_1S; + duration = 1100; + } + if (_heater == SHT4X_MED_HEATER_100MS) { + cmd = SHT4x_MEDHEAT_100MS; + duration = 110; + } + + if (_heater == SHT4X_LOW_HEATER_1S) { + cmd = SHT4x_LOWHEAT_1S; + duration = 1100; + } + if (_heater == SHT4X_LOW_HEATER_100MS) { + cmd = SHT4x_LOWHEAT_100MS; + duration = 110; + } + // _i2c.writeByte(_addr, cmd, 1); + _wire->beginTransmission(_addr); + _wire->write(cmd); + _wire->write(1); + _wire->endTransmission(); + + + delay(duration); + + _wire->requestFrom(_addr, (uint8_t)6); + + for (uint16_t i = 0; i < 6; i++) { + readbuffer[i] = _wire->read(); + } + + if (readbuffer[2] != crc8(readbuffer, 2) || + readbuffer[5] != crc8(readbuffer + 3, 2)) { + return false; + } + + float t_ticks = (uint16_t)readbuffer[0] * 256 + (uint16_t)readbuffer[1]; + float rh_ticks = (uint16_t)readbuffer[3] * 256 + (uint16_t)readbuffer[4]; + + cTemp = -45 + 175 * t_ticks / 65535; + humidity = -6 + 125 * rh_ticks / 65535; + humidity = min(max(humidity, (float)0.0), (float)100.0); + return true; +} + +void SHT4X::setPrecision(sht4x_precision_t prec) { + _precision = prec; +} + +sht4x_precision_t SHT4X::getPrecision(void) { + return _precision; +} + +void SHT4X::setHeater(sht4x_heater_t heat) { + _heater = heat; +} + +sht4x_heater_t SHT4X::getHeater(void) { + return _heater; +} +#endif \ No newline at end of file diff --git a/lib/iictask/SHT4X.h b/lib/iictask/SHT4X.h new file mode 100644 index 0000000..dbfbabf --- /dev/null +++ b/lib/iictask/SHT4X.h @@ -0,0 +1,76 @@ +#ifndef __SHT4X_H_ +#define __SHT4X_H_ + +#include "Arduino.h" +#include "Wire.h" + +#define SHT40_I2C_ADDR_44 0x44 +#define SHT40_I2C_ADDR_45 0x45 +#define SHT41_I2C_ADDR_44 0x44 +#define SHT41_I2C_ADDR_45 0x45 +#define SHT45_I2C_ADDR_44 0x44 +#define SHT45_I2C_ADDR_45 0x45 + +#define SHT4x_DEFAULT_ADDR 0x44 /**< SHT4x I2C Address */ +#define SHT4x_NOHEAT_HIGHPRECISION \ + 0xFD /**< High precision measurement, no heater */ +#define SHT4x_NOHEAT_MEDPRECISION \ + 0xF6 /**< Medium precision measurement, no heater */ +#define SHT4x_NOHEAT_LOWPRECISION \ + 0xE0 /**< Low precision measurement, no heater */ + +#define SHT4x_HIGHHEAT_1S \ + 0x39 /**< High precision measurement, high heat for 1 sec */ +#define SHT4x_HIGHHEAT_100MS \ + 0x32 /**< High precision measurement, high heat for 0.1 sec */ +#define SHT4x_MEDHEAT_1S \ + 0x2F /**< High precision measurement, med heat for 1 sec */ +#define SHT4x_MEDHEAT_100MS \ + 0x24 /**< High precision measurement, med heat for 0.1 sec */ +#define SHT4x_LOWHEAT_1S \ + 0x1E /**< High precision measurement, low heat for 1 sec */ +#define SHT4x_LOWHEAT_100MS \ + 0x15 /**< High precision measurement, low heat for 0.1 sec */ + +#define SHT4x_READSERIAL 0x89 /**< Read Out of Serial Register */ +#define SHT4x_SOFTRESET 0x94 /**< Soft Reset */ + +typedef enum { + SHT4X_HIGH_PRECISION, + SHT4X_MED_PRECISION, + SHT4X_LOW_PRECISION, +} sht4x_precision_t; + +/** Optional pre-heater configuration setting */ +typedef enum { + SHT4X_NO_HEATER, + SHT4X_HIGH_HEATER_1S, + SHT4X_HIGH_HEATER_100MS, + SHT4X_MED_HEATER_1S, + SHT4X_MED_HEATER_100MS, + SHT4X_LOW_HEATER_1S, + SHT4X_LOW_HEATER_100MS, +} sht4x_heater_t; + +class SHT4X { + public: + bool begin(TwoWire* wire = &Wire, uint8_t addr = SHT40_I2C_ADDR_44); + bool update(void); + + float cTemp = 0; + float humidity = 0; + + void setPrecision(sht4x_precision_t prec); + sht4x_precision_t getPrecision(void); + void setHeater(sht4x_heater_t heat); + sht4x_heater_t getHeater(void); + + private: + TwoWire* _wire; + uint8_t _addr; + + sht4x_precision_t _precision = SHT4X_HIGH_PRECISION; + sht4x_heater_t _heater = SHT4X_NO_HEATER; +}; + +#endif diff --git a/lib/iictask/config.json b/lib/iictask/config.json index 54da57e..5cd50af 100644 --- a/lib/iictask/config.json +++ b/lib/iictask/config.json @@ -1,49 +1,77 @@ [ { "type": "array", - "name": "SHT3X", + "name": "SHTXX", "replace": [ { "b": "1", "i": "11", - "n": "99" + "n": "99", + "x": "3" }, { "b": "1", "i": "12", - "n": "98" + "n": "98", + "x": "3" }, { "b": "2", "i": "21", - "n": "109" + "n": "109", + "x": "3" }, { "b": "2", "i": "22", - "n": "108" + "n": "108", + "x": "3" + }, + { + "b": "1", + "i": "11", + "n": "119", + "x": "4" + }, + { + "b": "1", + "i": "12", + "n": "118", + "x": "4" + }, + { + "b": "2", + "i": "21", + "n": "129", + "x": "4" + }, + { + "b": "2", + "i": "22", + "n": "128", + "x": "4" } ], "children": [ { - "name": "SHT3X$itmAct", - "label": "SHT3X$i Temp", + "name": "SHT$xX$itmAct", + "label": "SHT$xX$i Temp", "type": "boolean", "default": "true", - "description": "Enable the $i. I2C SHT3x temp sensor (bus $b)", + "description": "Enable the $i. I2C SHT$xX temp sensor (bus $b)", "category": "iicsensors$b", "capabilities": { - "SHT3X$i": "true" + "SHT$xX$i": "true" } }, { - "name": "SHT3X$itmSrc", - "label": "SHT3X$i Temp Type", + "name": "SHT$xX$itmSrc", + "label": "SHT$xX$i Temp Type", "type": "list", "default": "2", - "description": "the NMEA2000 source type for the temperature", + "description": "the NMEA2000 source type for the temperature (PGN 130312,130311)", "list": [ { "l": "SeaTemperature", @@ -112,23 +140,23 @@ ], "category": "iicsensors$b", "capabilities": { - "SHT3X$i": "true" + "SHT$xX$i": "true" } }, { - "name": "SHT3X$ihuAct", - "label": "SHT3X$i Humidity", + "name": "SHT$xX$ihuAct", + "label": "SHT$xX$i Humidity", "type": "boolean", "default": "true", - "description": "Enable the $i. I2C SHT3x humidity sensor (bus $b)", + "description": "Enable the $i. I2C SHT$xX humidity sensor (bus $b)", "category": "iicsensors$b", "capabilities": { - "SHT3X$i": "true" + "SHT$xX$i": "true" } }, { - "name": "SHT3X$ihuSrc", - "label": "SHT3X$i Humid Type", + "name": "SHT$xX$ihuSrc", + "label": "SHT$xX$i Humid Type", "list": [ { "l": "OutsideHumidity", @@ -141,57 +169,68 @@ ], "category": "iicsensors$b", "capabilities": { - "SHT3X": "true" + "SHT$xX": "true" } }, { - "name": "SHT3X$iiid", - "label": "SHT3X$i N2K iid", + "name": "SHT$xX$iiid", + "label": "SHT$xX$i N2K iid", "type": "number", "default": "$n", - "description": "the N2K instance id for the $i. SHT3X Temperature and Humidity ", + "description": "the N2K instance id for the $i. SHT$xX Temperature and Humidity (PGN 130312,130311) ", "category": "iicsensors$b", "min": 0, "max": 253, "check": "checkMinMax", "capabilities": { - "SHT3X$i": "true" + "SHT$xX$i": "true" } }, { - "name": "SHT3X$iintv", - "label": "SHT3X$i Interval", + "name": "SHT$xX$isEnv", + "label": "SHT$xX$i send Env", + "type": "boolean", + "default": "true", + "description": "also send PGN 130311", + "category": "iicsensors$b", + "capabilities": { + "SHT$xX$i": "true" + } + }, + { + "name": "SHT$xX$iintv", + "label": "SHT$xX$i Interval", "type": "number", "default": 2, - "description": "Interval(s) to query SHT3X Temperature and Humidity (1...300)", + "description": "Interval(s) to query SHT$xX Temperature and Humidity (1...300)", "category": "iicsensors$b", "min": 1, "max": 300, "check": "checkMinMax", "capabilities": { - "SHT3X$i": "true" + "SHT$xX$i": "true" } }, { - "name": "SHT3X$itmNam", - "label": "SHT3X$i Temp XDR", + "name": "SHT$xX$itmNam", + "label": "SHT$xX$i Temp XDR", "type": "String", "default": "Temp$i", - "description": "set the XDR transducer name for the $i. SHT3X Temperature, leave empty to disable NMEA0183 XDR ", + "description": "set the XDR transducer name for the $i. SHT$xX Temperature, leave empty to disable NMEA0183 XDR ", "category": "iicsensors$b", "capabilities": { - "SHT3X$i": "true" + "SHT$xX$i": "true" } }, { - "name": "SHT3X$ihuNam", - "label": "SHT3X$i Humid XDR", + "name": "SHT$xX$ihuNam", + "label": "SHT$xX$i Humid XDR", "type": "String", "default": "Humidity$i", - "description": "set the XDR transducer name for the $i. SHT3X Humidity, leave empty to disable NMEA0183 XDR", + "description": "set the XDR transducer name for the $i. SHT$xX Humidity, leave empty to disable NMEA0183 XDR", "category": "iicsensors$b", "capabilities": { - "SHT3X$i": "true" + "SHT$xX$i": "true" } } ] @@ -247,6 +286,17 @@ "QMP6988$i": "true" } }, + { + "name": "QMP6988$isEnv", + "label": "QMP6988$i send Env", + "type": "boolean", + "default": "true", + "description": "also send PGN 130311", + "category": "iicsensors$b", + "capabilities": { + "QMP6988$i": "true" + } + }, { "name": "QMP6988$iintv", "label": "QMP6988-$i Interval", @@ -473,7 +523,7 @@ "label": "BME280-$i N2K iid", "type": "number", "default": "$n", - "description": "the N2K instance id for the BME280 Temperature and Humidity ", + "description": "the N2K instance id for the BME280 Temperature, Humidity, Pressure (PGN 130312,130313, 130314) ", "category": "iicsensors$b", "min": 0, "max": 253, @@ -482,6 +532,17 @@ "BME280$i": "true" } }, + { + "name": "BME280$isEnv", + "label": "BME280$i send Env", + "type": "boolean", + "default": "true", + "description": "also send PGN 130311", + "category": "iicsensors$b", + "capabilities": { + "BME280$i": "true" + } + }, { "name": "BME280$iintv", "label": "BME280-$i Interval", @@ -683,7 +744,7 @@ "label": "BMP280-$i N2K iid", "type": "number", "default": "$n", - "description": "the N2K instance id for the BMP280 Temperature", + "description": "the N2K instance id for the BMP280 Temperature/Pressure (PGN 130312,130314)", "category": "iicsensors$b", "min": 0, "max": 253, @@ -692,6 +753,17 @@ "BMP280$i": "true" } }, + { + "name": "BMP280$isEnv", + "label": "BMP280$i send Env", + "type": "boolean", + "default": "true", + "description": "also send PGN 130311", + "category": "iicsensors$b", + "capabilities": { + "BMP280$i": "true" + } + }, { "name": "BMP280$iintv", "label": "BMP280-$i Interval", diff --git a/lib/iictask/platformio.ini b/lib/iictask/platformio.ini index c0f10f7..31e17a3 100644 --- a/lib/iictask/platformio.ini +++ b/lib/iictask/platformio.ini @@ -11,6 +11,17 @@ build_flags= -D M5_CAN_KIT ${env.build_flags} +[env:m5stack-atom-env4] +extends = sensors +board = m5stack-atom +lib_deps = + ${env.lib_deps} + ${sensors.lib_deps} +build_flags= + -D M5_ENV4 + -D M5_CAN_KIT + ${env.build_flags} + [env:m5stack-atom-bme280] extends = sensors diff --git a/lib/nmea0183ton2k/NMEA0183AIStoNMEA2000.h b/lib/nmea0183ton2k/NMEA0183AIStoNMEA2000.h index 169f181..5f4e5ee 100644 --- a/lib/nmea0183ton2k/NMEA0183AIStoNMEA2000.h +++ b/lib/nmea0183ton2k/NMEA0183AIStoNMEA2000.h @@ -2,7 +2,7 @@ This code 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 2.1 of the License, or (at your option) any later version. + version 2 of the License, or (at your option) any later version. This code 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 @@ -27,6 +27,8 @@ const double nmTom = 1.852 * 1000; uint16_t DaysSince1970 = 0; +#define boolbit(b) (b?1:0) + class MyAisDecoder : public AIS::AisDecoder { public: @@ -82,25 +84,24 @@ class MyAisDecoder : public AIS::AisDecoder tN2kMsg N2kMsg; - // PGN129038 - - N2kMsg.SetPGN(129038L); - N2kMsg.Priority = 4; - N2kMsg.AddByte((_Repeat & 0x03) << 6 | (_uMsgType & 0x3f)); - N2kMsg.Add4ByteUInt(_uMmsi); - N2kMsg.Add4ByteDouble(_iPosLon / 600000.0, 1e-07); - N2kMsg.Add4ByteDouble(_iPosLat / 600000.0, 1e-07); - N2kMsg.AddByte((_timestamp & 0x3f) << 2 | (_Raim & 0x01) << 1 | (_bPosAccuracy & 0x01)); - N2kMsg.Add2ByteUDouble(decodeCog(_iCog), 1e-04); - N2kMsg.Add2ByteUDouble(_uSog * knToms/10.0, 0.01); - N2kMsg.AddByte(0x00); // Communication State (19 bits) - N2kMsg.AddByte(0x00); - N2kMsg.AddByte(0x00); // AIS transceiver information (5 bits) - N2kMsg.Add2ByteUDouble(decodeHeading(_iHeading), 1e-04); - N2kMsg.Add2ByteDouble(decodeRot(_iRot), 3.125E-05); // 1e-3/32.0 - N2kMsg.AddByte(0xF0 | (_uNavstatus & 0x0f)); - N2kMsg.AddByte(0xff); // Reserved - N2kMsg.AddByte(0xff); // SID (NA) + SetN2kPGN129038( + N2kMsg, + _uMsgType, + (tN2kAISRepeat)_Repeat, + _uMmsi, + _iPosLon/ 600000.0, + _iPosLat / 600000.0, + _bPosAccuracy, + _Raim, + _timestamp, + decodeCog(_iCog), + _uSog * knToms/10.0, + tN2kAISTransceiverInformation::N2kaischannel_A_VDL_reception, + decodeHeading(_iHeading), + decodeRot(_iRot), + (tN2kAISNavStatus)_uNavstatus, + 0xff + ); send(N2kMsg); } @@ -255,9 +256,40 @@ class MyAisDecoder : public AIS::AisDecoder send(N2kMsg); } - - virtual void onType21(unsigned int , unsigned int , const std::string &, bool , int , int , unsigned int , unsigned int , unsigned int , unsigned int ) override { + //mmsi, aidType, name + nameExt, posAccuracy, posLon, posLat, toBow, toStern, toPort, toStarboard + virtual void onType21(unsigned int mmsi , unsigned int aidType , const std::string & name, bool accuracy, int posLon, int posLat, unsigned int toBow, + unsigned int toStern, unsigned int toPort, unsigned int toStarboard, + unsigned int repeat,unsigned int timestamp, bool raim, bool virtualAton, bool offPosition) override { //Serial.println("21"); + //the name can be at most 120bit+88bit (35 byte) + termination -> 36 Byte + //in principle we should use tN2kAISAtoNReportData to directly call the library + //function for 129041. But this makes the conversion really complex. + bool assignedMode=false; + tN2kGNSStype gnssType=tN2kGNSStype::N2kGNSSt_GPS; //canboat considers 0 as undefined... + tN2kAISTransceiverInformation transceiverInfo=tN2kAISTransceiverInformation::N2kaischannel_A_VDL_reception; + tN2kMsg N2kMsg; + N2kMsg.SetPGN(129041); + N2kMsg.Priority=4; + N2kMsg.AddByte((repeat & 0x03) << 6 | (21 & 0x3f)); + N2kMsg.Add4ByteUInt(mmsi); //N2kData.UserID + N2kMsg.Add4ByteDouble(posLon / 600000.0, 1e-07); + N2kMsg.Add4ByteDouble(posLat / 600000.0, 1e-07); + N2kMsg.AddByte((timestamp & 0x3f)<<2 | boolbit(raim)<<1 | boolbit(accuracy)); + N2kMsg.Add2ByteUDouble(toBow+toStern, 0.1); + N2kMsg.Add2ByteUDouble(toPort+toStarboard, 0.1); + N2kMsg.Add2ByteUDouble(toStarboard, 0.1); + N2kMsg.Add2ByteUDouble(toBow, 0.1); + N2kMsg.AddByte(boolbit(assignedMode) << 7 + | boolbit(virtualAton) << 6 + | boolbit(offPosition) << 5 + | (aidType & 0x1f)); + N2kMsg.AddByte((gnssType & 0x0F) << 1 | 0xe0); + N2kMsg.AddByte(N2kUInt8NA); //status + N2kMsg.AddByte((transceiverInfo & 0x1f) | 0xe0); + //bit offset 208 (see canboat/pgns.xml) -> 26 bytes from start + //as MaxDataLen is 223 and the string can be at most 36 bytes + 2 byte heading - no further check here + N2kMsg.AddVarStr(name.c_str()); + send(N2kMsg); } virtual void onType24A(unsigned int _uMsgType, unsigned int _repeat, unsigned int _uMmsi, diff --git a/lib/nmea0183ton2k/NMEA0183DataToN2K.cpp b/lib/nmea0183ton2k/NMEA0183DataToN2K.cpp index 123755f..238af38 100644 --- a/lib/nmea0183ton2k/NMEA0183DataToN2K.cpp +++ b/lib/nmea0183ton2k/NMEA0183DataToN2K.cpp @@ -143,7 +143,7 @@ private: */ GwXDRFoundMapping getOtherFieldMapping(GwXDRFoundMapping &found, int field){ if (found.empty) return GwXDRFoundMapping(); - return xdrMappings->getMapping(found.definition->category, + return xdrMappings->getMapping(0,found.definition->category, found.definition->selector, field, found.instanceId); diff --git a/lib/nmea2kto0183/N2kDataToNMEA0183.cpp b/lib/nmea2kto0183/N2kDataToNMEA0183.cpp index dbf6af5..0c0e68c 100644 --- a/lib/nmea2kto0183/N2kDataToNMEA0183.cpp +++ b/lib/nmea2kto0183/N2kDataToNMEA0183.cpp @@ -708,12 +708,37 @@ private: } } + //helper for converting the AIS transceiver info to talker/channel + + void setTalkerChannel(tNMEA0183AISMsg &msg, tN2kAISTransceiverInformation &transceiver){ + bool channelA=true; + bool own=false; + switch (transceiver){ + case tN2kAISTransceiverInformation::N2kaischannel_A_VDL_reception: + channelA=true; + own=false; + break; + case tN2kAISTransceiverInformation::N2kaischannel_B_VDL_reception: + channelA=false; + own=false; + break; + case tN2kAISTransceiverInformation::N2kaischannel_A_VDL_transmission: + channelA=true; + own=true; + break; + case tN2kAISTransceiverInformation::N2kaischannel_B_VDL_transmission: + channelA=false; + own=true; + break; + } + msg.SetChannelAndTalker(channelA,own); + } + //***************************************************************************** // 129038 AIS Class A Position Report (Message 1, 2, 3) void HandleAISClassAPosReport(const tN2kMsg &N2kMsg) { - unsigned char SID; tN2kAISRepeat _Repeat; uint32_t _UserID; // MMSI double _Latitude =N2kDoubleNA; @@ -732,64 +757,19 @@ private: uint8_t _MessageType = 1; tNMEA0183AISMsg NMEA0183AISMsg; - if (ParseN2kPGN129038(N2kMsg, SID, _Repeat, _UserID, _Latitude, _Longitude, _Accuracy, _RAIM, _Seconds, + if (ParseN2kPGN129038(N2kMsg, _MessageType, _Repeat, _UserID, _Latitude, _Longitude, _Accuracy, _RAIM, _Seconds, _COG, _SOG, _Heading, _ROT, _NavStatus,_AISTransceiverInformation,_SID)) { -// Debug -#ifdef SERIAL_PRINT_AIS_FIELDS - Serial.println("–––––––––––––––––––––––– Msg 1 ––––––––––––––––––––––––––––––––"); - - const double pi = 3.1415926535897932384626433832795; - const double radToDeg = 180.0 / pi; - const double msTokn = 3600.0 / 1852.0; - const double radsToDegMin = 60 * 360.0 / (2 * pi); // [rad/s -> degree/minute] - Serial.print("Repeat: "); - Serial.println(_Repeat); - Serial.print("UserID: "); - Serial.println(_UserID); - Serial.print("Latitude: "); - Serial.println(_Latitude); - Serial.print("Longitude: "); - Serial.println(_Longitude); - Serial.print("Accuracy: "); - Serial.println(_Accuracy); - Serial.print("RAIM: "); - Serial.println(_RAIM); - Serial.print("Seconds: "); - Serial.println(_Seconds); - Serial.print("COG: "); - Serial.println(_COG * radToDeg); - Serial.print("SOG: "); - Serial.println(_SOG * msTokn); - Serial.print("Heading: "); - Serial.println(_Heading * radToDeg); - Serial.print("ROT: "); - Serial.println(_ROT * radsToDegMin); - Serial.print("NavStatus: "); - Serial.println(_NavStatus); -#endif + setTalkerChannel(NMEA0183AISMsg,_AISTransceiverInformation); + if (_MessageType < 1 || _MessageType > 3) _MessageType=1; //only allow type 1...3 for 129038 if (SetAISClassABMessage1(NMEA0183AISMsg, _MessageType, _Repeat, _UserID, _Latitude, _Longitude, _Accuracy, _RAIM, _Seconds, _COG, _SOG, _Heading, _ROT, _NavStatus)) { SendMessage(NMEA0183AISMsg); -#ifdef SERIAL_PRINT_AIS_NMEA - // Debug Print AIS-NMEA - Serial.print(NMEA0183AISMsg.GetPrefix()); - Serial.print(NMEA0183AISMsg.Sender()); - Serial.print(NMEA0183AISMsg.MessageCode()); - for (int i = 0; i < NMEA0183AISMsg.FieldCount(); i++) - { - Serial.print(","); - Serial.print(NMEA0183AISMsg.Field(i)); - } - char buf[7]; - sprintf(buf, "*%02X\r\n", NMEA0183AISMsg.GetCheckSum()); - Serial.print(buf); -#endif } } } // end 129038 AIS Class A Position Report Message 1/3 @@ -825,84 +805,18 @@ private: _Length, _Beam, _PosRefStbd, _PosRefBow, _ETAdate, _ETAtime, _Draught, _Destination,21, _AISversion, _GNSStype, _DTE, _AISinfo,_SID)) { - -#ifdef SERIAL_PRINT_AIS_FIELDS - // Debug Print N2k Values - Serial.println("––––––––––––––––––––––– Msg 5 –––––––––––––––––––––––––––––––––"); - Serial.print("MessageID: "); - Serial.println(_MessageID); - Serial.print("Repeat: "); - Serial.println(_Repeat); - Serial.print("UserID: "); - Serial.println(_UserID); - Serial.print("IMONumber: "); - Serial.println(_IMONumber); - Serial.print("Callsign: "); - Serial.println(_Callsign); - Serial.print("VesselType: "); - Serial.println(_VesselType); - Serial.print("Name: "); - Serial.println(_Name); - Serial.print("Length: "); - Serial.println(_Length); - Serial.print("Beam: "); - Serial.println(_Beam); - Serial.print("PosRefStbd: "); - Serial.println(_PosRefStbd); - Serial.print("PosRefBow: "); - Serial.println(_PosRefBow); - Serial.print("ETAdate: "); - Serial.println(_ETAdate); - Serial.print("ETAtime: "); - Serial.println(_ETAtime); - Serial.print("Draught: "); - Serial.println(_Draught); - Serial.print("Destination: "); - Serial.println(_Destination); - Serial.print("GNSStype: "); - Serial.println(_GNSStype); - Serial.print("DTE: "); - Serial.println(_DTE); - Serial.println("––––––––––––––––––––––– Msg 5 –––––––––––––––––––––––––––––––––"); -#endif - + setTalkerChannel(NMEA0183AISMsg,_AISinfo); if (SetAISClassAMessage5(NMEA0183AISMsg, _MessageID, _Repeat, _UserID, _IMONumber, _Callsign, _Name, _VesselType, _Length, _Beam, _PosRefStbd, _PosRefBow, _ETAdate, _ETAtime, _Draught, _Destination, - _GNSStype, _DTE)) + _GNSStype, _DTE,_AISversion)) { - - SendMessage(NMEA0183AISMsg.BuildMsg5Part1(NMEA0183AISMsg)); - -#ifdef SERIAL_PRINT_AIS_NMEA - // Debug Print AIS-NMEA Message Type 5, Part 1 - char buf[7]; - Serial.print(NMEA0183AISMsg.GetPrefix()); - Serial.print(NMEA0183AISMsg.Sender()); - Serial.print(NMEA0183AISMsg.MessageCode()); - for (int i = 0; i < NMEA0183AISMsg.FieldCount(); i++) - { - Serial.print(","); - Serial.print(NMEA0183AISMsg.Field(i)); + if (NMEA0183AISMsg.BuildMsg5Part1()){ + SendMessage(NMEA0183AISMsg); } - sprintf(buf, "*%02X\r\n", NMEA0183AISMsg.GetCheckSum()); - Serial.print(buf); -#endif - - SendMessage(NMEA0183AISMsg.BuildMsg5Part2(NMEA0183AISMsg)); - -#ifdef SERIAL_PRINT_AIS_NMEA - // Print AIS-NMEA Message Type 5, Part 2 - Serial.print(NMEA0183AISMsg.GetPrefix()); - Serial.print(NMEA0183AISMsg.Sender()); - Serial.print(NMEA0183AISMsg.MessageCode()); - for (int i = 0; i < NMEA0183AISMsg.FieldCount(); i++) - { - Serial.print(","); - Serial.print(NMEA0183AISMsg.Field(i)); + if (NMEA0183AISMsg.BuildMsg5Part2()){ + SendMessage(NMEA0183AISMsg); } - sprintf(buf, "*%02X\r\n", NMEA0183AISMsg.GetCheckSum()); - Serial.print(buf); -#endif + } } } @@ -926,35 +840,21 @@ private: tN2kAISUnit _Unit; bool _Display, _DSC, _Band, _Msg22, _State; tN2kAISMode _Mode; - tN2kAISTransceiverInformation _AISTranceiverInformation; + tN2kAISTransceiverInformation _AISTransceiverInformation; uint8_t _SID; if (ParseN2kPGN129039(N2kMsg, _MessageID, _Repeat, _UserID, _Latitude, _Longitude, _Accuracy, _RAIM, - _Seconds, _COG, _SOG, _AISTranceiverInformation, _Heading, _Unit, _Display, _DSC, _Band, _Msg22, _Mode, _State,_SID)) + _Seconds, _COG, _SOG, _AISTransceiverInformation, _Heading, _Unit, _Display, _DSC, _Band, _Msg22, _Mode, _State,_SID)) { tNMEA0183AISMsg NMEA0183AISMsg; - + setTalkerChannel(NMEA0183AISMsg,_AISTransceiverInformation); if (SetAISClassBMessage18(NMEA0183AISMsg, _MessageID, _Repeat, _UserID, _Latitude, _Longitude, _Accuracy, _RAIM, _Seconds, _COG, _SOG, _Heading, _Unit, _Display, _DSC, _Band, _Msg22, _Mode, _State)) { SendMessage(NMEA0183AISMsg); -#ifdef SERIAL_PRINT_AIS_NMEA - // Debug Print AIS-NMEA - Serial.print(NMEA0183AISMsg.GetPrefix()); - Serial.print(NMEA0183AISMsg.Sender()); - Serial.print(NMEA0183AISMsg.MessageCode()); - for (int i = 0; i < NMEA0183AISMsg.FieldCount(); i++) - { - Serial.print(","); - Serial.print(NMEA0183AISMsg.Field(i)); - } - char buf[7]; - sprintf(buf, "*%02X\r\n", NMEA0183AISMsg.GetCheckSum()); - Serial.print(buf); -#endif } } return; @@ -976,8 +876,10 @@ private: { tNMEA0183AISMsg NMEA0183AISMsg; + setTalkerChannel(NMEA0183AISMsg,_AISInfo); if (SetAISClassBMessage24PartA(NMEA0183AISMsg, _MessageID, _Repeat, _UserID, _Name)) { + SendMessage(NMEA0183AISMsg); } } return; @@ -1005,77 +907,51 @@ private: _Length, _Beam, _PosRefStbd, _PosRefBow, _MothershipID,_AISInfo,_SID)) { -// -#ifdef SERIAL_PRINT_AIS_FIELDS - // Debug Print N2k Values - Serial.println("––––––––––––––––––––––– Msg 24 ––––––––––––––––––––––––––––––––"); - Serial.print("MessageID: "); - Serial.println(_MessageID); - Serial.print("Repeat: "); - Serial.println(_Repeat); - Serial.print("UserID: "); - Serial.println(_UserID); - Serial.print("VesselType: "); - Serial.println(_VesselType); - Serial.print("Vendor: "); - Serial.println(_Vendor); - Serial.print("Callsign: "); - Serial.println(_Callsign); - Serial.print("Length: "); - Serial.println(_Length); - Serial.print("Beam: "); - Serial.println(_Beam); - Serial.print("PosRefStbd: "); - Serial.println(_PosRefStbd); - Serial.print("PosRefBow: "); - Serial.println(_PosRefBow); - Serial.print("MothershipID: "); - Serial.println(_MothershipID); - Serial.println("––––––––––––––––––––––– Msg 24 ––––––––––––––––––––––––––––––––"); -#endif - tNMEA0183AISMsg NMEA0183AISMsg; - - if (SetAISClassBMessage24(NMEA0183AISMsg, _MessageID, _Repeat, _UserID, _VesselType, _Vendor, _Callsign, + setTalkerChannel(NMEA0183AISMsg,_AISInfo); + if (SetAISClassBMessage24PartB(NMEA0183AISMsg, _MessageID, _Repeat, _UserID, _VesselType, _Vendor, _Callsign, _Length, _Beam, _PosRefStbd, _PosRefBow, _MothershipID)) { - - SendMessage(NMEA0183AISMsg.BuildMsg24PartA(NMEA0183AISMsg)); - -#ifdef SERIAL_PRINT_AIS_NMEA - // Debug Print AIS-NMEA - char buf[7]; - Serial.print(NMEA0183AISMsg.GetPrefix()); - Serial.print(NMEA0183AISMsg.Sender()); - Serial.print(NMEA0183AISMsg.MessageCode()); - for (int i = 0; i < NMEA0183AISMsg.FieldCount(); i++) - { - Serial.print(","); - Serial.print(NMEA0183AISMsg.Field(i)); - } - sprintf(buf, "*%02X\r\n", NMEA0183AISMsg.GetCheckSum()); - Serial.print(buf); -#endif - - SendMessage(NMEA0183AISMsg.BuildMsg24PartB(NMEA0183AISMsg)); - -#ifdef SERIAL_PRINT_AIS_NMEA - Serial.print(NMEA0183AISMsg.GetPrefix()); - Serial.print(NMEA0183AISMsg.Sender()); - Serial.print(NMEA0183AISMsg.MessageCode()); - for (int i = 0; i < NMEA0183AISMsg.FieldCount(); i++) - { - Serial.print(","); - Serial.print(NMEA0183AISMsg.Field(i)); - } - sprintf(buf, "*%02X\r\n", NMEA0183AISMsg.GetCheckSum()); - Serial.print(buf); -#endif + SendMessage(NMEA0183AISMsg); } } return; } + //***************************************************************************** + // PGN 129041 Aton + void HandleAISMessage21(const tN2kMsg &N2kMsg) + { + tN2kAISAtoNReportData data; + if (ParseN2kPGN129041(N2kMsg,data)){ + tNMEA0183AISMsg nmea0183Msg; + setTalkerChannel(nmea0183Msg,data.AISTransceiverInformation); + if (SetAISMessage21( + nmea0183Msg, + data.Repeat, + data.UserID, + data.Latitude, + data.Longitude, + data.Accuracy, + data.RAIM, + data.Seconds, + data.Length, + data.Beam, + data.PositionReferenceStarboard, + data.PositionReferenceTrueNorth, + data.AtoNType, + data.OffPositionIndicator, + data.VirtualAtoNFlag, + data.AssignedModeFlag, + data.GNSSType, + data.AtoNStatus, + data.AtoNName + )){ + SendMessage(nmea0183Msg); + } + } + } + void HandleSystemTime(const tN2kMsg &msg){ unsigned char sid=-1; uint16_t DaysSince1970=N2kUInt16NA; @@ -1271,12 +1147,12 @@ private: double Level=N2kDoubleNA; double Capacity=N2kDoubleNA; if (ParseN2kPGN127505(N2kMsg,Instance,FluidType,Level,Capacity)) { - GwXDRFoundMapping mapping=xdrMappings->getMapping(XDRFLUID,FluidType,0,Instance); + GwXDRFoundMapping mapping=xdrMappings->getMapping(Level,XDRFLUID,FluidType,0,Instance); if (updateDouble(&mapping,Level)){ LOG_DEBUG(GwLog::DEBUG+1,"found fluidlevel mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(Level)); } - mapping=xdrMappings->getMapping(XDRFLUID,FluidType,1,Instance); + mapping=xdrMappings->getMapping(Capacity, XDRFLUID,FluidType,1,Instance); if (updateDouble(&mapping,Capacity)){ LOG_DEBUG(GwLog::DEBUG+1,"found fluid capacity mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(Capacity)); @@ -1294,19 +1170,19 @@ private: double BatteryTemperature=N2kDoubleNA; if (ParseN2kPGN127508(N2kMsg,BatteryInstance,BatteryVoltage,BatteryCurrent,BatteryTemperature,SID)) { int i=0; - GwXDRFoundMapping mapping=xdrMappings->getMapping(XDRBAT,0,0,BatteryInstance); + GwXDRFoundMapping mapping=xdrMappings->getMapping(BatteryVoltage, XDRBAT,0,0,BatteryInstance); if (updateDouble(&mapping,BatteryVoltage)){ LOG_DEBUG(GwLog::DEBUG+1,"found BatteryVoltage mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(BatteryVoltage)); i++; } - mapping=xdrMappings->getMapping(XDRBAT,0,1,BatteryInstance); + mapping=xdrMappings->getMapping(BatteryCurrent,XDRBAT,0,1,BatteryInstance); if (updateDouble(&mapping,BatteryCurrent)){ LOG_DEBUG(GwLog::DEBUG+1,"found BatteryCurrent mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(BatteryCurrent)); i++; } - mapping=xdrMappings->getMapping(XDRBAT,0,2,BatteryInstance); + mapping=xdrMappings->getMapping(BatteryTemperature,XDRBAT,0,2,BatteryInstance); if (updateDouble(&mapping,BatteryTemperature)){ LOG_DEBUG(GwLog::DEBUG+1,"found BatteryTemperature mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(BatteryTemperature)); @@ -1338,13 +1214,13 @@ private: SendMessage(NMEA0183Msg); } int i=0; - GwXDRFoundMapping mapping=xdrMappings->getMapping(XDRTEMP,N2kts_OutsideTemperature,0,0); + GwXDRFoundMapping mapping=xdrMappings->getMapping(OutsideAmbientAirTemperature, XDRTEMP,N2kts_OutsideTemperature,0,0); if (updateDouble(&mapping,OutsideAmbientAirTemperature)){ LOG_DEBUG(GwLog::DEBUG+1,"found temperature mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(OutsideAmbientAirTemperature)); i++; } - mapping=xdrMappings->getMapping(XDRPRESSURE,N2kps_Atmospheric,0,0); + mapping=xdrMappings->getMapping(AtmosphericPressure,XDRPRESSURE,N2kps_Atmospheric,0,0); if (updateDouble(&mapping,AtmosphericPressure)){ LOG_DEBUG(GwLog::DEBUG+1,"found pressure mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(AtmosphericPressure)); @@ -1379,19 +1255,19 @@ private: SendMessage(NMEA0183Msg); } - GwXDRFoundMapping mapping=xdrMappings->getMapping(XDRTEMP,TempSource,0,0); + GwXDRFoundMapping mapping=xdrMappings->getMapping(Temperature, XDRTEMP,TempSource,0,0); if (updateDouble(&mapping,Temperature)){ LOG_DEBUG(GwLog::DEBUG+1,"found temperature mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(Temperature)); i++; } - mapping=xdrMappings->getMapping(XDRHUMIDITY,HumiditySource,0,0); + mapping=xdrMappings->getMapping(Humidity, XDRHUMIDITY,HumiditySource,0,0); if (updateDouble(&mapping,Humidity)){ LOG_DEBUG(GwLog::DEBUG+1,"found humidity mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(Humidity)); i++; } - mapping=xdrMappings->getMapping(XDRPRESSURE,N2kps_Atmospheric,0,0); + mapping=xdrMappings->getMapping(AtmosphericPressure, XDRPRESSURE,N2kps_Atmospheric,0,0); if (updateDouble(&mapping,AtmosphericPressure)){ LOG_DEBUG(GwLog::DEBUG+1,"found pressure mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(AtmosphericPressure)); @@ -1426,12 +1302,12 @@ private: SendMessage(NMEA0183Msg); } - GwXDRFoundMapping mapping=xdrMappings->getMapping(XDRTEMP,(int)TemperatureSource,0,TemperatureInstance); + GwXDRFoundMapping mapping=xdrMappings->getMapping(Temperature, XDRTEMP,(int)TemperatureSource,0,TemperatureInstance); if (updateDouble(&mapping,Temperature)){ LOG_DEBUG(GwLog::DEBUG+1,"found temperature mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(Temperature)); } - mapping=xdrMappings->getMapping(XDRTEMP,(int)TemperatureSource,1,TemperatureInstance); + mapping=xdrMappings->getMapping(setTemperature, XDRTEMP,(int)TemperatureSource,1,TemperatureInstance); if (updateDouble(&mapping,setTemperature)){ LOG_DEBUG(GwLog::DEBUG+1,"found temperature mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(setTemperature)); @@ -1449,12 +1325,13 @@ private: LOG_DEBUG(GwLog::DEBUG,"unable to parse PGN %d",msg.PGN); return; } - GwXDRFoundMapping mapping=xdrMappings->getMapping(XDRHUMIDITY,(int)HumiditySource,0,HumidityInstance); + GwXDRFoundMapping mapping; + mapping=xdrMappings->getMapping(ActualHumidity, XDRHUMIDITY,(int)HumiditySource,0,HumidityInstance); if (updateDouble(&mapping,ActualHumidity)){ LOG_DEBUG(GwLog::DEBUG+1,"found humidity mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(ActualHumidity)); } - mapping=xdrMappings->getMapping(XDRHUMIDITY,(int)HumiditySource,1,HumidityInstance); + mapping=xdrMappings->getMapping(SetHumidity, XDRHUMIDITY,(int)HumiditySource,1,HumidityInstance); if (updateDouble(&mapping,SetHumidity)){ LOG_DEBUG(GwLog::DEBUG+1,"found humidity mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(SetHumidity)); @@ -1472,7 +1349,7 @@ private: LOG_DEBUG(GwLog::DEBUG,"unable to parse PGN %d",msg.PGN); return; } - GwXDRFoundMapping mapping=xdrMappings->getMapping(XDRPRESSURE,(int)PressureSource,0,PressureInstance); + GwXDRFoundMapping mapping=xdrMappings->getMapping(ActualPressure, XDRPRESSURE,(int)PressureSource,0,PressureInstance); if (! updateDouble(&mapping,ActualPressure)) return; LOG_DEBUG(GwLog::DEBUG+1,"found pressure mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(ActualPressure)); @@ -1490,12 +1367,12 @@ private: LOG_DEBUG(GwLog::DEBUG,"unable to parse PGN %d",msg.PGN); } for (int i=0;i<8;i++){ - GwXDRFoundMapping mapping=xdrMappings->getMapping(XDRENGINE,0,i,instance); + GwXDRFoundMapping mapping=xdrMappings->getMapping(values[i], XDRENGINE,0,i,instance); if (! updateDouble(&mapping,values[i])) continue; addToXdr(mapping.buildXdrEntry(values[i])); } for (int i=0;i< 2;i++){ - GwXDRFoundMapping mapping=xdrMappings->getMapping(XDRENGINE,0,i+8,instance); + GwXDRFoundMapping mapping=xdrMappings->getMapping(ivalues[i],XDRENGINE,0,i+8,instance); if (! updateDouble(&mapping,ivalues[i])) continue; addToXdr(mapping.buildXdrEntry((double)ivalues[i])); } @@ -1511,7 +1388,7 @@ private: LOG_DEBUG(GwLog::DEBUG,"unable to parse PGN %d",msg.PGN); } for (int i=0;i<3;i++){ - GwXDRFoundMapping mapping=xdrMappings->getMapping(XDRATTITUDE,0,i,instance); + GwXDRFoundMapping mapping=xdrMappings->getMapping(values[i], XDRATTITUDE,0,i,instance); if (! updateDouble(&mapping,values[i])) continue; addToXdr(mapping.buildXdrEntry(values[i])); } @@ -1525,15 +1402,15 @@ private: speed,pressure,tilt)){ LOG_DEBUG(GwLog::DEBUG,"unable to parse PGN %d",msg.PGN); } - GwXDRFoundMapping mapping=xdrMappings->getMapping(XDRENGINE,0,10,instance); + GwXDRFoundMapping mapping=xdrMappings->getMapping(speed, XDRENGINE,0,10,instance); if (updateDouble(&mapping,speed)){ addToXdr(mapping.buildXdrEntry(speed)); } - mapping=xdrMappings->getMapping(XDRENGINE,0,11,instance); + mapping=xdrMappings->getMapping(pressure, XDRENGINE,0,11,instance); if (updateDouble(&mapping,pressure)){ addToXdr(mapping.buildXdrEntry(pressure)); } - mapping=xdrMappings->getMapping(XDRENGINE,0,12,instance); + mapping=xdrMappings->getMapping(tilt, XDRENGINE,0,12,instance); if (updateDouble(&mapping,tilt)){ addToXdr(mapping.buildXdrEntry((double)tilt)); } @@ -1559,12 +1436,12 @@ private: LOG_DEBUG(GwLog::DEBUG,"unable to parse PGN %d",msg.PGN); return; } - GwXDRFoundMapping mapping=xdrMappings->getMapping(XDRTEMP,(int)TemperatureSource,0,TemperatureInstance); + GwXDRFoundMapping mapping=xdrMappings->getMapping(Temperature, XDRTEMP,(int)TemperatureSource,0,TemperatureInstance); if (updateDouble(&mapping,Temperature)){ LOG_DEBUG(GwLog::DEBUG+1,"found temperature mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(Temperature)); } - mapping=xdrMappings->getMapping(XDRTEMP,(int)TemperatureSource,1,TemperatureInstance); + mapping=xdrMappings->getMapping(setTemperature, XDRTEMP,(int)TemperatureSource,1,TemperatureInstance); if (updateDouble(&mapping,setTemperature)){ LOG_DEBUG(GwLog::DEBUG+1,"found temperature mapping %s",mapping.definition->toString().c_str()); addToXdr(mapping.buildXdrEntry(setTemperature)); @@ -1614,6 +1491,7 @@ private: converters.registerConverter(129794UL, &N2kToNMEA0183Functions::HandleAISClassAMessage5); // AIS Class A Ship Static and Voyage related data, Message Type 5 converters.registerConverter(129809UL, &N2kToNMEA0183Functions::HandleAISClassBMessage24A); // AIS Class B "CS" Static Data Report, Part A converters.registerConverter(129810UL, &N2kToNMEA0183Functions::HandleAISClassBMessage24B); // AIS Class B "CS" Static Data Report, Part B + converters.registerConverter(129041UL, &N2kToNMEA0183Functions::HandleAISMessage21); // AIS Aton #endif } diff --git a/lib/nmea2ktoais/NMEA0183AISMessages.cpp b/lib/nmea2ktoais/NMEA0183AISMessages.cpp index a0f9ec0..7a64d70 100644 --- a/lib/nmea2ktoais/NMEA0183AISMessages.cpp +++ b/lib/nmea2ktoais/NMEA0183AISMessages.cpp @@ -26,7 +26,7 @@ OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */ -#include +#include "NMEA0183AISMessages.h" #include #include #include @@ -34,7 +34,7 @@ OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. //#include #include #include -#include +#include "NMEA0183AISMsg.h" const double pi=3.1415926535897932384626433832795; const double kmhToms=1000.0/3600.0; @@ -47,17 +47,15 @@ const double nmTom=1.852*1000; const double mToFathoms=0.546806649; const double mToFeet=3.2808398950131; const double radsToDegMin = 60 * 360.0 / (2 * pi); // [rad/s -> degree/minute] -const char Prefix='!'; -std::vector vships; -int numShips(){return vships.size();} // ************************ Helper for AIS *********************************** static bool AddMessageType(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageType); static bool AddRepeat(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t Repeat); static bool AddUserID(tNMEA0183AISMsg &NMEA0183AISMsg, uint32_t UserID); static bool AddIMONumber(tNMEA0183AISMsg &NMEA0183AISMsg, uint32_t &IMONumber); static bool AddText(tNMEA0183AISMsg &NMEA0183AISMsg, char *FieldVal, uint8_t length); +//static bool AddVesselType(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t VesselType); static bool AddDimensions(tNMEA0183AISMsg &NMEA0183AISMsg, double Length, double Beam, double PosRefStbd, double PosRefBow); static bool AddNavStatus(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t &NavStatus); static bool AddROT(tNMEA0183AISMsg &NMEA0183AISMsg, double &rot); @@ -81,8 +79,8 @@ static bool AddETADateTime(tNMEA0183AISMsg &NMEA0183AISMsg, uint16_t &ETAdate, d // // Got values from: ParseN2kPGN129038() bool SetAISClassABMessage1( tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageType, uint8_t Repeat, - uint32_t UserID, double Latitude, double Longitude, bool Accuracy, bool RAIM, uint8_t Seconds, - double COG, double SOG, double Heading, double ROT, uint8_t NavStatus ) { + uint32_t UserID, double Latitude, double Longitude, bool Accuracy, bool RAIM, uint8_t Seconds, + double COG, double SOG, double Heading, double ROT, uint8_t NavStatus ) { NMEA0183AISMsg.ClearAIS(); if ( !AddMessageType(NMEA0183AISMsg, MessageType) ) return false; // 0 - 5 | 6 Message Type -> Constant: 1 @@ -91,7 +89,7 @@ bool SetAISClassABMessage1( tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageType if ( !AddNavStatus(NMEA0183AISMsg, NavStatus) ) return false; // 38-41 | 4 Navigational Status e.g.: "Under way sailing" if ( !AddROT(NMEA0183AISMsg, ROT) ) return false; // 42-49 | 8 Rate of Turn (ROT) if ( !AddSOG(NMEA0183AISMsg, SOG) ) return false; // 50-59 | 10 [m/s -> kts] SOG with one digit x10, 1023 = N/A - if ( !NMEA0183AISMsg.AddBoolToPayloadBin(Accuracy, 1) ) return false;// 60 | 1 GPS Accuracy 1 oder 0, Default 0 + if ( !NMEA0183AISMsg.AddBoolToPayloadBin(Accuracy) ) return false;// 60 | 1 GPS Accuracy 1 oder 0, Default 0 if ( !AddLongitude(NMEA0183AISMsg, Longitude) ) return false; // 61-88 | 28 Longitude in Minutes / 10000 if ( !AddLatitude(NMEA0183AISMsg, Latitude) ) return false; // 89-115 | 27 Latitude in Minutes / 10000 if ( !AddCOG(NMEA0183AISMsg, COG) ) return false; // 116-127 | 12 Course over ground will be 3600 (0xE10) if that data is not available. @@ -99,17 +97,12 @@ bool SetAISClassABMessage1( tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageType if ( !AddSeconds(NMEA0183AISMsg, Seconds) ) return false; // 137-142 | 6 Seconds in UTC timestamp) if ( !NMEA0183AISMsg.AddIntToPayloadBin(0, 2) ) return false; // 143-144 | 2 Maneuver Indicator: 0 (default) 1, 2 (not delivered within this PGN) if ( !NMEA0183AISMsg.AddIntToPayloadBin(0, 3) ) return false; // 145-147 | 3 Spare - if ( !NMEA0183AISMsg.AddBoolToPayloadBin(RAIM, 1) ) return false; // 148-148 | 1 RAIM flag 0 = RAIM not in use (default), 1 = RAIM in use + if ( !NMEA0183AISMsg.AddBoolToPayloadBin(RAIM) ) return false; // 148-148 | 1 RAIM flag 0 = RAIM not in use (default), 1 = RAIM in use if ( !NMEA0183AISMsg.AddIntToPayloadBin(0, 19) ) return false; // 149-167 | 19 Radio Status (-> 0 NOT SENT WITH THIS PGN!!!!!) - - if ( !NMEA0183AISMsg.Init("VDM","AI", Prefix) ) return false; - if ( !NMEA0183AISMsg.AddStrField("1") ) return false; - if ( !NMEA0183AISMsg.AddStrField("1") ) return false; - if ( !NMEA0183AISMsg.AddEmptyField() ) return false; - if ( !NMEA0183AISMsg.AddStrField("A") ) return false; - if ( !NMEA0183AISMsg.AddStrField( NMEA0183AISMsg.GetPayload() ) ) return false; - if ( !NMEA0183AISMsg.AddStrField("0") ) return false; // Message 1,2,3 has always Zero Padding - + if ( !NMEA0183AISMsg.InitAis()) return false; + int padBits=0; + if ( !NMEA0183AISMsg.AddStrField( NMEA0183AISMsg.GetPayloadFix(padBits) ) ) return false; + if ( !NMEA0183AISMsg.AddUInt32Field(padBits) ) return false; return true; } @@ -121,14 +114,16 @@ bool SetAISClassAMessage5(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageID, u uint32_t UserID, uint32_t IMONumber, char *Callsign, char *Name, uint8_t VesselType, double Length, double Beam, double PosRefStbd, double PosRefBow, uint16_t ETAdate, double ETAtime, double Draught, - char *Destination, tN2kGNSStype GNSStype, uint8_t DTE ) { + char *Destination, tN2kGNSStype GNSStype, uint8_t DTE, + tN2kAISVersion AISversion) { // AIS Type 5 Message NMEA0183AISMsg.ClearAIS(); if ( !AddMessageType(NMEA0183AISMsg, 5) ) return false; // 0 - 5 | 6 Message Type -> Constant: 5 if ( !AddRepeat(NMEA0183AISMsg, Repeat) ) return false; // 6 - 7 | 2 Repeat Indicator: 0 = default; 3 = do not repeat any more if ( !AddUserID(NMEA0183AISMsg, UserID) ) return false; // 8 - 37 | 30 MMSI - if ( !NMEA0183AISMsg.AddIntToPayloadBin(1, 2) ) return false; // 38 - 39 | 2 AIS Version -> 0 oder 1 NOT DERIVED FROM N2k, Always 1!!!! + if ( !NMEA0183AISMsg.AddIntToPayloadBin((uint32_t)AISversion, 2) ) + return false; // 38 - 39 | 2 AIS Version -> 0 oder 1 NOT DERIVED FROM N2k, Always 1!!!! if ( !AddIMONumber(NMEA0183AISMsg, IMONumber) ) return false; // 40 - 69 | 30 IMO Number unisgned if ( !AddText(NMEA0183AISMsg, Callsign, 42) ) return false; // 70 - 111 | 42 Call Sign WDE4178 -> 7 6-bit characters -> Ascii lt. Table) if ( !AddText(NMEA0183AISMsg, Name, 120) ) return false; // 112-231 | 120 Vessel Name POINT FERMIN -> 20 6-bit characters -> Ascii lt. Table @@ -146,15 +141,17 @@ bool SetAISClassAMessage5(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageID, u // **************************************************************************** // AIS position report (class B 129039) -> Type 18: Standard Class B CS Position Report -// ParseN2kPGN129039(const tN2kMsg &N2kMsg, uint8_t &MessageID, tN2kAISRepeat &Repeat, uint32_t &UserID, +// PGN129039 +// ParseN2kAISClassBPosition(const tN2kMsg &N2kMsg, uint8_t &MessageID, tN2kAISRepeat &Repeat, uint32_t &UserID, // double &Latitude, double &Longitude, bool &Accuracy, bool &RAIM, -// uint8_t &Seconds, double &COG, double &SOG, double &Heading, tN2kAISUnit &Unit, -// bool &Display, bool &DSC, bool &Band, bool &Msg22, tN2kAISMode &Mode, bool &State) +// uint8_t &Seconds, double &COG, double &SOG, tN2kAISTransceiverInformation &AISTransceiverInformation, +// double &Heading, tN2kAISUnit &Unit, bool &Display, bool &DSC, bool &Band, bool &Msg22, tN2kAISMode &Mode, +// bool &State) // VDM, VDO (AIS VHF Data-link message 18) bool SetAISClassBMessage18(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageID, uint8_t Repeat, uint32_t UserID, - double Latitude, double Longitude, bool Accuracy, bool RAIM, - uint8_t Seconds, double COG, double SOG, double Heading, tN2kAISUnit Unit, - bool Display, bool DSC, bool Band, bool Msg22, bool Mode, bool State) { + double Latitude, double Longitude, bool Accuracy, bool RAIM, + uint8_t Seconds, double COG, double SOG, double Heading, tN2kAISUnit Unit, + bool Display, bool DSC, bool Band, bool Msg22, bool Mode, bool State) { // NMEA0183AISMsg.ClearAIS(); if ( !AddMessageType(NMEA0183AISMsg, MessageID) ) return false; // 0 - 5 | 6 Message Type -> Constant: 18 @@ -162,7 +159,7 @@ bool SetAISClassBMessage18(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageID, u if ( !AddUserID(NMEA0183AISMsg, UserID) ) return false; // 8 - 37 | 30 MMSI if ( !NMEA0183AISMsg.AddIntToPayloadBin(0, 8) ) return false; // 38-45 | 8 Regional Reserved if ( !AddSOG(NMEA0183AISMsg, SOG) ) return false; // 46-55 | 10 [m/s -> kts] SOG with one digit x10, 1023 = N/A - if ( !NMEA0183AISMsg.AddBoolToPayloadBin(Accuracy, 1)) return false; // 56 | 1 GPS Accuracy 1 oder 0, Default 0 + if ( !NMEA0183AISMsg.AddBoolToPayloadBin(Accuracy)) return false; // 56 | 1 GPS Accuracy 1 oder 0, Default 0 if ( !AddLongitude(NMEA0183AISMsg, Longitude) ) return false; // 57-84 | 28 Longitude in Minutes / 10000 if ( !AddLatitude(NMEA0183AISMsg, Latitude) ) return false; // 85-111 | 27 Latitude in Minutes / 10000 if ( !AddCOG(NMEA0183AISMsg, COG) ) return false; // 112-123 | 12 Course over ground will be 3600 (0xE10) if that data is not available. @@ -171,20 +168,16 @@ bool SetAISClassBMessage18(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageID, u if ( !NMEA0183AISMsg.AddIntToPayloadBin(0, 2) ) return false; // 139-140 | 2 Regional Reserved if ( !NMEA0183AISMsg.AddIntToPayloadBin(Unit, 1) ) return false; // 141 | 1 0=Class B SOTDMA unit 1=Class B CS (Carrier Sense) unit if ( !NMEA0183AISMsg.AddIntToPayloadBin(Display, 1) ) return false; // 142 | 1 0=No visual display, 1=Has display, (Probably not reliable). - if ( !NMEA0183AISMsg.AddBoolToPayloadBin(DSC, 1) ) return false; // 143 | 1 If 1, unit is attached to a VHF voice radio with DSC capability. - if ( !NMEA0183AISMsg.AddBoolToPayloadBin(Band, 1) ) return false; // 144 | 1 If this flag is 1, the unit can use any part of the marine channel. - if ( !NMEA0183AISMsg.AddBoolToPayloadBin(Msg22, 1) ) return false; // 145 | 1 If 1, unit can accept a channel assignment via Message Type 22. - if ( !NMEA0183AISMsg.AddBoolToPayloadBin(Mode, 1) ) return false; // 146 | 1 Assigned-mode flag: 0 = autonomous mode (default), 1 = assigned mode - if ( !NMEA0183AISMsg.AddBoolToPayloadBin(RAIM, 1) ) return false; // 147 | 1 as for Message Type 1,2,3 + if ( !NMEA0183AISMsg.AddBoolToPayloadBin(DSC) ) return false; // 143 | 1 If 1, unit is attached to a VHF voice radio with DSC capability. + if ( !NMEA0183AISMsg.AddBoolToPayloadBin(Band) ) return false; // 144 | 1 If this flag is 1, the unit can use any part of the marine channel. + if ( !NMEA0183AISMsg.AddBoolToPayloadBin(Msg22)) return false; // 145 | 1 If 1, unit can accept a channel assignment via Message Type 22. + if ( !NMEA0183AISMsg.AddBoolToPayloadBin(Mode) ) return false; // 146 | 1 Assigned-mode flag: 0 = autonomous mode (default), 1 = assigned mode + if ( !NMEA0183AISMsg.AddBoolToPayloadBin(RAIM) ) return false; // 147 | 1 as for Message Type 1,2,3 if ( !NMEA0183AISMsg.AddIntToPayloadBin(0, 20) ) return false; // 148-167 | 20 Radio Status not in PGN 129039 - - if ( !NMEA0183AISMsg.Init("VDM","AI", Prefix) ) return false; - if ( !NMEA0183AISMsg.AddStrField("1") ) return false; - if ( !NMEA0183AISMsg.AddStrField("1") ) return false; - if ( !NMEA0183AISMsg.AddEmptyField() ) return false; - if ( !NMEA0183AISMsg.AddStrField("B") ) return false; - if ( !NMEA0183AISMsg.AddStrField( NMEA0183AISMsg.GetPayload() ) ) return false; - if ( !NMEA0183AISMsg.AddStrField("0") ) return false; // Message 18, has always Zero Padding + if ( !NMEA0183AISMsg.InitAis()) return false; + int padBits=0; + if ( !NMEA0183AISMsg.AddStrField( NMEA0183AISMsg.GetPayloadFix(padBits) ) ) return false; + if ( !NMEA0183AISMsg.AddUInt32Field(padBits) ) return false; return true; } @@ -209,7 +202,7 @@ bool SetAISClassBMessage18(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageID, u // // PGN 129809 AIS Class B "CS" Static Data Report, Part A -> AIS VHF Data-link message 24 // PGN 129810 AIS Class B "CS" Static Data Report, Part B -> AIS VHF Data-link message 24 -// ParseN2kPGN129809 (const tN2kMsg &N2kMsg, uint8_t &MessageID, tN2kAISRepeat &Repeat, uint32_t &UserID, char *Name) -> store to vector +// ParseN2kPGN129809 (const tN2kMsg &N2kMsg, uint8_t &MessageID, tN2kAISRepeat &Repeat, uint32_t &UserID, char *Name) -> store to vector // ParseN2kPGN129810(const tN2kMsg &N2kMsg, uint8_t &MessageID, tN2kAISRepeat &Repeat, uint32_t &UserID, // uint8_t &VesselType, char *Vendor, char *Callsign, double &Length, double &Beam, // double &PosRefStbd, double &PosRefBow, uint32_t &MothershipID); @@ -217,41 +210,28 @@ bool SetAISClassBMessage18(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageID, u // Part A: MessageID, Repeat, UserID, ShipName -> store in vector to call on Part B arrivals!!! // Part B: MessageID, Repeat, UserID, VesselType (5), Callsign (5), Length & Beam, PosRefBow,.. (5) bool SetAISClassBMessage24PartA(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageID, uint8_t Repeat, uint32_t UserID, char *Name) { - - bool found = false; - for (size_t i = 0; i < vships.size(); i++) { - if ( vships[i]->_userID == UserID ) { - found = true; - break; - } - } - if ( ! found ) { - std::string nm; - nm+= Name; - vships.push_back(new ship(UserID, nm)); - } + // AIS Type 24 Message + NMEA0183AISMsg.ClearAIS(); + // Common for PART A AND Part B Bit 0 - 39 / len 40 + if ( !AddMessageType(NMEA0183AISMsg, 24) ) return false; // 0 - 5 | 6 Message Type -> Constant: 24 + if ( !AddRepeat(NMEA0183AISMsg, Repeat) ) return false; // 6 - 7 | 2 Repeat Indicator: 0 = default; 3 = do not repeat any more + if ( !AddUserID(NMEA0183AISMsg, UserID) ) return false; // 8 - 37 | 30 MMSI + if ( !NMEA0183AISMsg.AddIntToPayloadBin(0, 2) ) return false; // 38-39 | 2 Part Number 0-1 -> + // Part A: 40 + 128 = len 168 + if ( !AddText(NMEA0183AISMsg, Name, 120) ) return false; // 40-159 | 120 Vessel Name 20 6-bit characters -> Ascii Table + if ( !NMEA0183AISMsg.AddIntToPayloadBin(0, 8) ) return false; // 160-167 | 8 Spare + if ( !NMEA0183AISMsg.InitAis() ) return false; + int padBits=0; + if ( !NMEA0183AISMsg.AddStrField( NMEA0183AISMsg.GetPayloadFix(padBits) ) ) return false; + if ( !NMEA0183AISMsg.AddUInt32Field(padBits) ) return false; return true; } // *************************************************************************************************************** -bool SetAISClassBMessage24(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageID, uint8_t Repeat, +bool SetAISClassBMessage24PartB(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageID, uint8_t Repeat, uint32_t UserID, uint8_t VesselType, char *VendorID, char *Callsign, double Length, double Beam, double PosRefStbd, double PosRefBow, uint32_t MothershipID ) { - uint8_t PartNr = 0; // Identifier for the message part number; always 0 for Part A - char *ShipName = (char*)" "; // get from vector to look up for sent Messages Part A - - uint8_t i; - for ( i = 0; i < vships.size(); i++) { - if ( vships[i]->_userID == UserID ) { - ShipName = const_cast( vships[i]->_shipName.c_str() ); - } - } - if ( i > MAX_SHIP_IN_VECTOR ) { - std::vector::iterator it=vships.begin(); - delete *it; - vships.erase(it); - } // AIS Type 24 Message NMEA0183AISMsg.ClearAIS(); @@ -259,11 +239,7 @@ bool SetAISClassBMessage24(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageID, if ( !AddMessageType(NMEA0183AISMsg, 24) ) return false; // 0 - 5 | 6 Message Type -> Constant: 24 if ( !AddRepeat(NMEA0183AISMsg, Repeat) ) return false; // 6 - 7 | 2 Repeat Indicator: 0 = default; 3 = do not repeat any more if ( !AddUserID(NMEA0183AISMsg, UserID) ) return false; // 8 - 37 | 30 MMSI - if ( !NMEA0183AISMsg.AddIntToPayloadBin(PartNr, 2) ) return false; // 38-39 | 2 Part Number 0-1 -> - - // Part A: 40 + 128 = len 168 - if ( !AddText(NMEA0183AISMsg, ShipName, 120) ) return false; // 40-159 | 120 Vessel Name 20 6-bit characters -> Ascii Table - if ( !NMEA0183AISMsg.AddIntToPayloadBin(0, 8) ) return false; // 160-167 | 8 Spare + if ( !NMEA0183AISMsg.AddIntToPayloadBin(1, 2) ) return false; // 38-39 | 2 Part Number 0-1 -> // https://www.navcen.uscg.gov/?pageName=AISMessagesB // PART B: 40 + 128 = len 168 @@ -272,6 +248,59 @@ bool SetAISClassBMessage24(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageID, if ( !AddText(NMEA0183AISMsg, Callsign, 42) ) return false; // 218-259 | 90-131 | 42 Call Sign WDE4178 -> 7 6-bit characters, as in Msg Type 5 if ( !AddDimensions(NMEA0183AISMsg, Length, Beam, PosRefStbd, PosRefBow) ) return false; // 260-289 | 132-161 | 30 Dimensions if ( !NMEA0183AISMsg.AddIntToPayloadBin(0, 6) ) return false; // 290-295 | 162-167 | 6 Spare + if ( !NMEA0183AISMsg.InitAis() ) return false; + int padBits=0; + if ( !NMEA0183AISMsg.AddStrField( NMEA0183AISMsg.GetPayloadFix(padBits) ) ) return false; + if ( !NMEA0183AISMsg.AddUInt32Field(padBits) ) return false; + return true; +} + +// **************************************************************************** +// AIS ATON report (129041) -> Type 21: Position and status report for aids-to-navigation +// PGN129041 + +bool SetAISMessage21(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t Repeat, uint32_t UserID, + double Latitude, double Longitude, bool Accuracy, bool RAIM, + uint8_t Seconds, double Length, double Beam, double PositionReferenceStarboard, + double PositionReferenceTrueNord, tN2kAISAtoNType Type, bool OffPositionIndicator, + bool VirtualAtoNFlag, bool AssignedModeFlag, tN2kGNSStype GNSSType, uint8_t AtoNStatus, + char * atonName ) { + // + NMEA0183AISMsg.ClearAIS(); + if ( !AddMessageType(NMEA0183AISMsg, 21) ) return false; // 0 - 5 | 6 Message Type -> Constant: 18 + if ( !AddRepeat(NMEA0183AISMsg, Repeat) ) return false; // 6 - 7 | 2 Repeat Indicator: 0 = default; 3 = do not repeat any more + if ( !AddUserID(NMEA0183AISMsg, UserID) ) return false; // 8 - 37 | 30 MMSI + if ( ! NMEA0183AISMsg.AddIntToPayloadBin(Type,5)) return false; // | 5 aid type + //the name must be split: + //if it's > 120 bits the rest goes to the last parameter + if ( !NMEA0183AISMsg.AddEncodedCharToPayloadBin(atonName,120)) + return false; // | 120 name + if ( !NMEA0183AISMsg.AddBoolToPayloadBin(Accuracy) ) return false; // | 1 accuracy + if ( !AddLongitude(NMEA0183AISMsg,Longitude)) return false; // | 28 lon + if ( !AddLatitude(NMEA0183AISMsg,Latitude)) return false; // | 27 lat + if ( !AddDimensions(NMEA0183AISMsg, Length, Beam, + PositionReferenceStarboard, PositionReferenceTrueNord)) return false; // | 30 dim + if ( !AddEPFDFixType(NMEA0183AISMsg,GNSSType)) return false; // | 4 fix type + if ( !AddSeconds(NMEA0183AISMsg,Seconds)) return false; // | 6 second + if ( !NMEA0183AISMsg.AddBoolToPayloadBin(OffPositionIndicator)) + return false; // | 1 off + if ( !NMEA0183AISMsg.AddIntToPayloadBin(0,8)) return false; // | 8 reserverd + if ( !NMEA0183AISMsg.AddBoolToPayloadBin(RAIM)) return false; // | 1 raim + if ( !NMEA0183AISMsg.AddBoolToPayloadBin(VirtualAtoNFlag)) + return false; // | 1 virt + if ( !NMEA0183AISMsg.AddBoolToPayloadBin(AssignedModeFlag)) + return false; // | 1 assigned + if ( !NMEA0183AISMsg.AddIntToPayloadBin(0,1)) return false; // | 1 spare + size_t l=strlen(atonName); + if (l >=20){ + uint8_t bitlen=(l-20)*6; + if (bitlen > 88) bitlen=88; + if ( !NMEA0183AISMsg.AddEncodedCharToPayloadBin(atonName+20,bitlen)) return false; // | name + } + if ( !NMEA0183AISMsg.InitAis() ) return false; + int padBits=0; + if ( !NMEA0183AISMsg.AddStrField( NMEA0183AISMsg.GetPayload(padBits) ) ) return false; + if ( !NMEA0183AISMsg.AddUInt32Field(padBits) ) return false; return true; } @@ -325,7 +354,6 @@ bool AddIMONumber(tNMEA0183AISMsg &NMEA0183AISMsg, uint32_t &IMONumber) { // 120bit Name or Destination bool AddText(tNMEA0183AISMsg &NMEA0183AISMsg, char *FieldVal, uint8_t length) { uint8_t len = length/6; - if ( strlen(FieldVal) > len ) FieldVal[len] = 0; if ( !NMEA0183AISMsg.AddEncodedCharToPayloadBin(FieldVal, length) ) return false; return true; @@ -347,29 +375,26 @@ bool AddDimensions(tNMEA0183AISMsg &NMEA0183AISMsg, double Length, double Beam, uint16_t _PosRefStbd = 0; uint16_t _PosRefPort = 0; - if (PosRefBow < 0) PosRefBow=0; //could be N2kIsNA - if ( PosRefBow <= 511.0 ) { - _PosRefBow = round(PosRefBow); + if ( PosRefBow >= 0.0 && PosRefBow <= 511.0 ) { + _PosRefBow = ceil(PosRefBow); } else { _PosRefBow = 511; } - if (PosRefStbd < 0 ) PosRefStbd=0; //could be N2kIsNA - if (PosRefStbd <= 63.0 ) { - _PosRefStbd = round(PosRefStbd); + + if ( PosRefStbd >= 0.0 && PosRefStbd <= 63.0 ) { + _PosRefStbd = ceil(PosRefStbd); } else { _PosRefStbd = 63; } if ( !N2kIsNA(Length) ) { - if (Length >= PosRefBow){ - _PosRefStern=round(Length - PosRefBow); - } + _PosRefStern = ceil( Length ) - _PosRefBow; + if ( _PosRefStern < 0 ) _PosRefStern = 0; if ( _PosRefStern > 511 ) _PosRefStern = 511; } if ( !N2kIsNA(Beam) ) { - if (Beam >= PosRefStbd){ - _PosRefPort = round( Beam - PosRefStbd); - } + _PosRefPort = ceil( Beam ) - _PosRefStbd; + if ( _PosRefPort < 0 ) _PosRefPort = 0; if ( _PosRefPort > 63 ) _PosRefPort = 63; } @@ -572,3 +597,5 @@ bool AddETADateTime(tNMEA0183AISMsg &NMEA0183AISMsg, uint16_t &ETAdate, double & if ( ! NMEA0183AISMsg.AddIntToPayloadBin(minute, 6) ) return false; return true; } + + diff --git a/lib/nmea2ktoais/NMEA0183AISMessages.h b/lib/nmea2ktoais/NMEA0183AISMessages.h index a124574..d818a2b 100644 --- a/lib/nmea2ktoais/NMEA0183AISMessages.h +++ b/lib/nmea2ktoais/NMEA0183AISMessages.h @@ -27,29 +27,21 @@ OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. #ifndef _tNMEA0183AISMessages_H_ #define _tNMEA0183AISMessages_H_ + #include #include #include #include -#include +#include "NMEA0183AISMsg.h" #include #include #include -#define MAX_SHIP_IN_VECTOR 200 -class ship { -public: - uint32_t _userID; - std::string _shipName; - - ship(uint32_t UserID, std::string ShipName) : _userID(UserID), _shipName(ShipName) {} -}; - // Types 1, 2 and 3: Position Report Class A or B bool SetAISClassABMessage1(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageType, uint8_t Repeat, - uint32_t UserID, double Latitude, double Longitude, bool Accuracy, bool RAIM, uint8_t Seconds, - double COG, double SOG, double Heading, double ROT, uint8_t NavStatus); + uint32_t UserID, double Latitude, double Longitude, bool Accuracy, bool RAIM, uint8_t Seconds, + double COG, double SOG, double Heading, double ROT, uint8_t NavStatus); //***************************************************************************** // AIS Class A Static and Voyage Related Data Message Type 5 @@ -57,14 +49,15 @@ bool SetAISClassAMessage5(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageID, ui uint32_t UserID, uint32_t IMONumber, char *Callsign, char *Name, uint8_t VesselType, double Length, double Beam, double PosRefStbd, double PosRefBow, uint16_t ETAdate, double ETAtime, double Draught, - char *Destination, tN2kGNSStype GNSStype, uint8_t DTE ); + char *Destination, tN2kGNSStype GNSStype, uint8_t DTE, + tN2kAISVersion AISversion); //***************************************************************************** // AIS position report (class B 129039) -> Standard Class B CS Position Report Message Type 18 Part B bool SetAISClassBMessage18(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageID, uint8_t Repeat, uint32_t UserID, - double Latitude, double Longitude, bool Accuracy, bool RAIM, - uint8_t Seconds, double COG, double SOG, double Heading, tN2kAISUnit Unit, - bool Display, bool DSC, bool Band, bool Msg22, bool Mode, bool State); + double Latitude, double Longitude, bool Accuracy, bool RAIM, + uint8_t Seconds, double COG, double SOG, double Heading, tN2kAISUnit Unit, + bool Display, bool DSC, bool Band, bool Msg22, bool Mode, bool State); //***************************************************************************** // Static Data Report Class B, Message Type 24 @@ -73,11 +66,19 @@ bool SetAISClassBMessage24PartA(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t Message //***************************************************************************** // Static Data Report Class B, Message Type 24 -bool SetAISClassBMessage24(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageID, uint8_t Repeat, +bool SetAISClassBMessage24PartB(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t MessageID, uint8_t Repeat, uint32_t UserID, uint8_t VesselType, char *VendorID, char *Callsign, double Length, double Beam, double PosRefStbd, double PosRefBow, uint32_t MothershipID ); -int numShips(); +//***************************************************************************** +// Aton class 21 +bool SetAISMessage21(tNMEA0183AISMsg &NMEA0183AISMsg, uint8_t Repeat, uint32_t UserID, + double Latitude, double Longitude, bool Accuracy, bool RAIM, + uint8_t Seconds, double Length, double Beam, double PositionReferenceStarboard, + double PositionReferenceTrueNord, tN2kAISAtoNType Type, bool OffPositionIndicator, + bool VirtualAtoNFlag, bool AssignedModeFlag, tN2kGNSStype GNSSType, uint8_t AtoNStatus, + char * atonName ); + inline int32_t aRoundToInt(double x) { return x >= 0 ? (int32_t) floor(x + 0.5) diff --git a/lib/nmea2ktoais/NMEA0183AISMsg.cpp b/lib/nmea2ktoais/NMEA0183AISMsg.cpp index 6abcf42..04118df 100644 --- a/lib/nmea2ktoais/NMEA0183AISMsg.cpp +++ b/lib/nmea2ktoais/NMEA0183AISMsg.cpp @@ -25,7 +25,7 @@ OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. #include "NMEA0183AISMsg.h" #include -#include +//#include #include #include #include @@ -43,52 +43,37 @@ tNMEA0183AISMsg::tNMEA0183AISMsg() { //***************************************************************************** void tNMEA0183AISMsg::ClearAIS() { - PayloadBin[0]=0; Payload[0]=0; + PayloadBin.reset(); iAddPldBin=0; iAddPld=0; } -//***************************************************************************** -// Add 6bit with no data. -bool tNMEA0183AISMsg::AddEmptyFieldToPayloadBin(uint8_t iBits) { - - if ( (iAddPldBin + iBits * 6) >= AIS_BIN_MAX_LEN ) return false; // Is there room for any data - - for (uint8_t i=0;i= AIS_BIN_MAX_LEN ) return false; // Is there room for any data - AISBitSet bset(ival); + bset = ival; - PayloadBin[iAddPldBin]=0; uint16_t iAdd=iAddPldBin; for(int i = countBits-1; i >= 0 ; i--) { - PayloadBin[iAdd] = bset[i]?'1':'0'; + PayloadBin[iAdd]=bset [i]; iAdd++; } iAddPldBin += countBits; - PayloadBin[iAddPldBin]=0; return true; } -// **************************************************************************** -bool tNMEA0183AISMsg::AddBoolToPayloadBin(bool &bval, uint8_t size) { - int8_t iTemp; - (bval == true)? iTemp = 1 : iTemp = 0; - if ( ! AddIntToPayloadBin(iTemp, size) ) return false; +//**************************************************************************** +bool tNMEA0183AISMsg::AddBoolToPayloadBin(bool &bval) { + if ( (iAddPldBin + 1 ) >= AIS_BIN_MAX_LEN ) return false; + PayloadBin[iAddPldBin]=bval; + iAddPldBin++; return true; } @@ -99,13 +84,11 @@ bool tNMEA0183AISMsg::AddEncodedCharToPayloadBin(char *sval, size_t countBits) { if ( (iAddPldBin + countBits ) >= AIS_BIN_MAX_LEN ) return false; // Is there room for any data - PayloadBin[iAddPldBin]=0; - std::bitset<6> bs; - char * ptr; + const char * ptr; size_t len = strlen(sval); // e.g.: should be 7 for Callsign if ( len * 6 > countBits ) len = countBits / 6; - for (int i = 0; i +int tNMEA0183AISMsg::ConvertBinaryAISPayloadBinToAscii(std::bitset &src,uint16_t maxSize,uint16_t bitSize,uint16_t stoffset) { + Payload[0]='\0'; + uint16_t slen=maxSize; + if (stoffset >= slen) return 0; + slen-=stoffset; + uint16_t bitLen=bitSize > 0?bitSize:slen; + uint16_t len= bitLen / 6; + if ((len * 6) < bitLen) len+=1; + uint16_t padBits=0; uint32_t offset; - char s[7]; + std::bitset<6> s; uint8_t dec; int i; for ( i=0; i= 0){ + if ( !AddUInt32Field(sequence) ) return false; + } + else{ + if ( !AddEmptyField() ) return false; + } + if ( !AddStrField(channel) ) return false; + return true; +} +bool tNMEA0183AISMsg::BuildMsg5Part1() { + if ( iAddPldBin != 424 ) return false; + InitAis(2,1,5); + int padBits=0; + AddStrField( GetPayload(padBits,0,336)); + AddUInt32Field(padBits); + return true; } -const tNMEA0183AISMsg& tNMEA0183AISMsg::BuildMsg5Part2(tNMEA0183AISMsg &AISMsg) { - - Init("VDM", "AI", '!'); - AddStrField("2"); - AddStrField("2"); - AddStrField("5"); - AddStrField("A"); - AddStrField( GetPayloadType5_Part2() ); - AddStrField("2"); // Message 5, Part 2 has always 2 Padding Zeros - - return AISMsg; +bool tNMEA0183AISMsg::BuildMsg5Part2() { + if ( iAddPldBin != 424 ) return false; + InitAis(2,2,5); + int padBits=0; + AddStrField( GetPayload(padBits,336,88) ); + AddUInt32Field(padBits); + return true; } -const tNMEA0183AISMsg& tNMEA0183AISMsg::BuildMsg24PartA(tNMEA0183AISMsg &AISMsg) { - - Init("VDM", "AI", '!'); - AddStrField("1"); - AddStrField("1"); - AddEmptyField(); - AddStrField("A"); - AddStrField( GetPayloadType24_PartA() ); - AddStrField("0"); - - return AISMsg; -} - -const tNMEA0183AISMsg& tNMEA0183AISMsg::BuildMsg24PartB(tNMEA0183AISMsg &AISMsg) { - - Init("VDM", "AI", '!'); - AddStrField("1"); - AddStrField("1"); - AddEmptyField(); - AddStrField("A"); - AddStrField( GetPayloadType24_PartB() ); - AddStrField("0"); // Message 24, both parts have always Zero Padding - - return AISMsg; -} //******************************* AIS PAYLOADS ********************************* -//****************************************************************************** // get converted Payload for Message 1, 2, 3 & 18, always Length 168 -const char *tNMEA0183AISMsg::GetPayload() { - - uint16_t lenbin = strlen( PayloadBin); - if ( lenbin != 168 ) return nullptr; - - if ( !ConvertBinaryAISPayloadBinToAscii( PayloadBin ) ) return nullptr; +const char *tNMEA0183AISMsg::GetPayloadFix(int &padBits,uint16_t fixLen){ + uint16_t lenbin = iAddPldBin; + if ( lenbin != fixLen ) return nullptr; + return GetPayload(padBits,0,0); +} +const char *tNMEA0183AISMsg::GetPayload(int &padBits,uint16_t offset,uint16_t bitLen) { + padBits=ConvertBinaryAISPayloadBinToAscii(PayloadBin,iAddPldBin, bitLen,offset ); return Payload; } -//****************************************************************************** -// get converted Part 1 of Payload for Message 5 -const char *tNMEA0183AISMsg::GetPayloadType5_Part1() { - - uint16_t lenbin = strlen( PayloadBin); - if ( lenbin != 424 ) return nullptr; - - char to[337]; - strncpy(to, PayloadBin, 336); // First Part is always 336 Length - to[336]=0; - - if ( !ConvertBinaryAISPayloadBinToAscii( to ) ) return nullptr; - - return Payload; -} - -//****************************************************************************** -// get converted Part 2 of Payload for Message 5 -const char *tNMEA0183AISMsg::GetPayloadType5_Part2() { - - uint16_t lenbin = strlen( PayloadBin); - if ( lenbin != 424 ) return nullptr; - - lenbin = 88; // Second Part is always 424 - 336 + 2 padding Zeros in Length - char to[91]; - strncpy(to, PayloadBin + 336, lenbin); - to[88]='0'; to[89]='0'; to[90]=0; - - if ( !ConvertBinaryAISPayloadBinToAscii( to ) ) return nullptr; - return Payload; -} - -//****************************************************************************** -// get converted Part A of Payload for Message 24 -// Bit 0.....167, len 168 -// In PayloadBin is Part A and Part B chained together with Length 296 -const char *tNMEA0183AISMsg::GetPayloadType24_PartA() { - uint16_t lenbin = strlen( PayloadBin); - if ( lenbin != 296 ) return nullptr; // too short for Part A - - char to[169]; // Part A has Length 168 - *to = '\0'; - for (int i=0; i<168; i++){ - to[i] = PayloadBin[i]; - } - to[168]=0; - if ( !ConvertBinaryAISPayloadBinToAscii( to ) ) return nullptr; - return Payload; - -} - -//****************************************************************************** -// get converted Part B of Payload for Message 24 -// Bit 0.....38 + bit39='1' (part number) + bit 168........295 296='\0' of total PayloadBin -// binary part B: len 40 + 128 = len 168 -const char *tNMEA0183AISMsg::GetPayloadType24_PartB() { - uint16_t lenbin = strlen( PayloadBin); - if ( lenbin != 296 ) return nullptr; // too short for Part B - char to[169]; // Part B has Length 168 - *to = '\0'; - for (int i=0; i<39; i++){ - to[i] = PayloadBin[i]; - } - to[39] = 49; // part number 1 - for (int i=40; i<168; i++) { - to[i] = PayloadBin[i+128]; - } - to[168]=0; - if ( !ConvertBinaryAISPayloadBinToAscii( to ) ) return nullptr; - return Payload; -} diff --git a/lib/nmea2ktoais/NMEA0183AISMsg.h b/lib/nmea2ktoais/NMEA0183AISMsg.h index 4dfbc7f..ae9f656 100644 --- a/lib/nmea2ktoais/NMEA0183AISMsg.h +++ b/lib/nmea2ktoais/NMEA0183AISMsg.h @@ -45,43 +45,48 @@ OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. #define BITSET_LENGTH 120 -typedef std::bitset AISBitSet; class tNMEA0183AISMsg : public tNMEA0183Msg { protected: // AIS-NMEA + std::bitset bset; static const char *EmptyAISField; // 6bits 0 not used yet..... static const char *AsciChar; uint16_t iAddPldBin; char Payload[AIS_MSG_MAX_LEN]; uint8_t iAddPld; - + char talker[4]="VDM"; + char channel[2]="A"; + std::bitset PayloadBin; public: - char PayloadBin[AIS_BIN_MAX_LEN]; - char PayloadBin2[AIS_BIN_MAX_LEN]; // Clear message void ClearAIS(); public: tNMEA0183AISMsg(); - const char *GetPayload(); - const char *GetPayloadType5_Part1(); - const char *GetPayloadType5_Part2(); - const char *GetPayloadType24_PartA(); - const char *GetPayloadType24_PartB(); - const char *GetPayloadBin() const { return PayloadBin; } + const char *GetPayloadFix(int &padBits,uint16_t fixLen=168); + const char *GetPayload(int &padBits,uint16_t offset=0,uint16_t bitLen=0); - const tNMEA0183AISMsg& BuildMsg5Part1(tNMEA0183AISMsg &AISMsg); - const tNMEA0183AISMsg& BuildMsg5Part2(tNMEA0183AISMsg &AISMsg); - const tNMEA0183AISMsg& BuildMsg24PartA(tNMEA0183AISMsg &AISMsg); - const tNMEA0183AISMsg& BuildMsg24PartB(tNMEA0183AISMsg &AISMsg); + bool BuildMsg5Part1(); + bool BuildMsg5Part2(); + bool InitAis(int max=1,int number=1,int sequence=-1); // Generally Used bool AddIntToPayloadBin(int32_t ival, uint16_t countBits); - bool AddBoolToPayloadBin(bool &bval, uint8_t size); + bool AddBoolToPayloadBin(bool &bval); bool AddEncodedCharToPayloadBin(char *sval, size_t Length); - bool AddEmptyFieldToPayloadBin(uint8_t iBits); - bool ConvertBinaryAISPayloadBinToAscii(const char *payloadbin); + /** + * @param channelA - if set A, otherwise B + * @param own - if set VDO, else VDM + */ + void SetChannelAndTalker(bool channelA,bool own=false); + /** + * convert the payload to ascii + * return the number of padding bits + * @param bitSize the number of bits to be used, 0 - use all bits + */ + template + int ConvertBinaryAISPayloadBinToAscii(std::bitset &src,uint16_t maxSize, uint16_t bitSize,uint16_t offset=0); // AIS Helper functions protected: diff --git a/lib/nmea2ktoais/README.md b/lib/nmea2ktoais/README.md index 9d83553..1d55424 100644 --- a/lib/nmea2ktoais/README.md +++ b/lib/nmea2ktoais/README.md @@ -1,11 +1,11 @@ -# NMEA2000 -> NMEA0183 AIS converter v1.0.0 +# NMEA2000 to NMEA0183 AIS Converter -Import from https://github.com/ronzeiller/NMEA0183-AIS NMEA0183 AIS library © Ronnie Zeiller, www.zeiller.eu Addendum for NMEA2000 and NMEA0183 Library from Timo Lappalainen https://github.com/ttlappalainen +to get NMEA0183 AIS data from N2k-bus ## Conversions: @@ -15,6 +15,33 @@ Addendum for NMEA2000 and NMEA0183 Library from Timo Lappalainen https://github. - NMEA2000 PGN 129809 => AIS Class B "CS" Static Data Report, making a list of UserID (MMSI) and Ship Names used for Message 24 Part A - NMEA2000 PGN 129810 => AIS Class B "CS" Static Data Report, Message 24 Part A+B +### Versions +1.0.6 2024-03-25 +- fixed to work with Timo´s NMEA2000 v4.21.3 + +1.0.5 2023-12-02 +- removed VDO remote print statements + +1.0.4 2023-12-02 +- merged @Isoltero master with fixed memory over run, added VDO remote print statements Thanks to Luis Soltero +- fixed example, thanks to @arduinomnomnom + +1.0.3 2022-05-01 +- Update Examples: AISTransceiverInformation in ParseN2kPGN129039 for changes in NMEA2000 library: https://github.com/ttlappalainen/NMEA2000 + + +1.0.2 2022-04-30 +- bugfix: malloc without free. Thanks to Luis Soltero (Issue https://github.com/ronzeiller/NMEA0183-AIS/issues/3) + +1.0.1 2022-03-15 +- bugfix: buffer overrun missing space for termination. Thanks to Luis Soltero (Issue https://github.com/ronzeiller/NMEA0183-AIS/issues/2) + +2020-12-25 +- corrected Navigational Status 0. Thanks to Li-Ren (Issue https://github.com/ronzeiller/NMEA0183-AIS/issues/1) + +1.0.0 2019-11-24 +- initial upload + ### Remarks 1. Message Type could be set to 1 or 3 (identical messages) on demand 2. Maneuver Indicator (not part of NMEA2000 PGN 129038) => will be set to 0 (default) @@ -33,17 +60,14 @@ To use this library you need also: ## License -Permission is hereby granted, free of charge, to any person obtaining a copy of -this software and associated documentation files (the "Software"), to deal in -the Software without restriction, including without limitation the rights to use, -copy, modify, merge, publish, distribute, sublicense, and/or sell copies of the -Software, and to permit persons to whom the Software is furnished to do so, -subject to the following conditions: -The above copyright notice and this permission notice shall be included in all -copies or substantial portions of the Software. -THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, -INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A -PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT -HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF -CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE -OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. +MIT license + +Copyright (c) 2019-2022 Ronnie Zeiller, www.zeiller.eu + +Permission is hereby granted, free of charge, to any person obtaining a copy of this software and associated documentation files (the "Software"), to deal in the Software without restriction, including without limitation the rights to use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is furnished to do so, subject to the following conditions: + + +The above copyright notice and this permission notice shall be included in all copies or substantial portions of the Software. + + +THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. diff --git a/lib/nmea2ktwai/Nmea2kTwai.cpp b/lib/nmea2ktwai/Nmea2kTwai.cpp index abc2c2e..501b6cb 100644 --- a/lib/nmea2ktwai/Nmea2kTwai.cpp +++ b/lib/nmea2ktwai/Nmea2kTwai.cpp @@ -162,8 +162,6 @@ bool Nmea2kTwai::checkRecovery(){ return strt; } - - void Nmea2kTwai::loop(){ if (disabled) return; timers.loop(); diff --git a/lib/obp60task/BoatDataCalibration.cpp b/lib/obp60task/BoatDataCalibration.cpp deleted file mode 100644 index 3b981fe..0000000 --- a/lib/obp60task/BoatDataCalibration.cpp +++ /dev/null @@ -1,190 +0,0 @@ -#if defined BOARD_OBP60S3 || defined BOARD_OBP40S3 - -#include "BoatDataCalibration.h" -#include -#include -#include - -CalibrationDataList calibrationData; -std::unordered_map CalibrationDataList::calibMap; // list of calibration data instances - -void CalibrationDataList::readConfig(GwConfigHandler* config, GwLog* logger) -// Initial load of calibration data into internal list -// This method is called once at init phase of to read the configuration values -{ - std::string instance; - double offset; - double slope; - double smooth; - - String calInstance = ""; - String calOffset = ""; - String calSlope = ""; - String calSmooth = ""; - - // Load user format configuration values - String lengthFormat = config->getString(config->lengthFormat); // [m|ft] - String distanceFormat = config->getString(config->distanceFormat); // [m|km|nm] - String speedFormat = config->getString(config->speedFormat); // [m/s|km/h|kn] - String windspeedFormat = config->getString(config->windspeedFormat); // [m/s|km/h|kn|bft] - String tempFormat = config->getString(config->tempFormat); // [K|C|F] - - // Read calibration settings for data instances - for (int i = 0; i < MAX_CALIBRATION_DATA; i++) { - calInstance = "calInstance" + String(i + 1); - calOffset = "calOffset" + String(i + 1); - calSlope = "calSlope" + String(i + 1); - calSmooth = "calSmooth" + String(i + 1); - - instance = std::string(config->getString(calInstance, "---").c_str()); - if (instance == "---") { - logger->logDebug(GwLog::LOG, "no calibration data for instance no. %d", i + 1); - continue; - } - calibMap[instance] = { 0.0f, 1.0f, 1.0f, 0.0f, false }; - offset = (config->getString(calOffset, "")).toFloat(); - slope = (config->getString(calSlope, "")).toFloat(); - smooth = (config->getString(calSmooth, "")).toInt(); // user input is int; further math is done with double - - // Convert calibration values to internal standard formats - if (instance == "AWS" || instance == "TWS") { - if (windspeedFormat == "m/s") { - // No conversion needed - } else if (windspeedFormat == "km/h") { - offset /= 3.6; // Convert km/h to m/s - } else if (windspeedFormat == "kn") { - offset /= 1.94384; // Convert kn to m/s - } else if (windspeedFormat == "bft") { - offset *= 2 + (offset / 2); // Convert Bft to m/s (approx) -> to be improved - } - - } else if (instance == "AWA" || instance == "COG" || instance == "TWA" || instance == "TWD" || instance == "HDM" || instance == "PRPOS" || instance == "RPOS") { - offset *= M_PI / 180; // Convert deg to rad - - } else if (instance == "DBT") { - if (lengthFormat == "m") { - // No conversion needed - } else if (lengthFormat == "ft") { - offset /= 3.28084; // Convert ft to m - } - - } else if (instance == "SOG" || instance == "STW") { - if (speedFormat == "m/s") { - // No conversion needed - } else if (speedFormat == "km/h") { - offset /= 3.6; // Convert km/h to m/s - } else if (speedFormat == "kn") { - offset /= 1.94384; // Convert kn to m/s - } - - } else if (instance == "WTemp") { - if (tempFormat == "K" || tempFormat == "C") { - // No conversion needed - } else if (tempFormat == "F") { - offset *= 9.0 / 5.0; // Convert °F to K - slope *= 9.0 / 5.0; // Convert °F to K - } - } - - // transform smoothing factor from {0.01..10} to {0.3..0.95} and invert for exponential smoothing formula - if (smooth <= 0) { - smooth = 0; - } else { - if (smooth > 10) { - smooth = 10; - } - smooth = 0.3 + ((smooth - 0.01) * (0.95 - 0.3) / (10 - 0.01)); - } - smooth = 1 - smooth; - - calibMap[instance].offset = offset; - calibMap[instance].slope = slope; - calibMap[instance].smooth = smooth; - calibMap[instance].isCalibrated = false; - logger->logDebug(GwLog::LOG, "calibration data: %s, offset: %f, slope: %f, smoothing: %f", instance.c_str(), - calibMap[instance].offset, calibMap[instance].slope, calibMap[instance].smooth); - } - logger->logDebug(GwLog::LOG, "all calibration data read"); -} - -void CalibrationDataList::calibrateInstance(GwApi::BoatValue* boatDataValue, GwLog* logger) -// Method to calibrate the boat data value -{ - std::string instance = boatDataValue->getName().c_str(); - double offset = 0; - double slope = 1.0; - double dataValue = 0; - std::string format = ""; - - if (calibMap.find(instance) == calibMap.end()) { - logger->logDebug(GwLog::DEBUG, "BoatDataCalibration: %s not in calibration list", instance.c_str()); - return; - } else if (!boatDataValue->valid) { // no valid boat data value, so we don't want to apply calibration data - calibMap[instance].isCalibrated = false; - return; - } else { - offset = calibMap[instance].offset; - slope = calibMap[instance].slope; - dataValue = boatDataValue->value; - format = boatDataValue->getFormat().c_str(); - logger->logDebug(GwLog::DEBUG, "BoatDataCalibration: %s: value: %f, format: %s", instance.c_str(), dataValue, format.c_str()); - - if (format == "formatWind") { // instance is of type angle - dataValue = (dataValue * slope) + offset; - dataValue = fmod(dataValue, 2 * M_PI); - if (dataValue > (M_PI)) { - dataValue -= (2 * M_PI); - } else if (dataValue < (M_PI * -1)) { - dataValue += (2 * M_PI); - } - } else if (format == "formatCourse") { // instance is of type direction - dataValue = (dataValue * slope) + offset; - dataValue = fmod(dataValue, 2 * M_PI); - if (dataValue < 0) { - dataValue += (2 * M_PI); - } - } else if (format == "kelvinToC") { // instance is of type temperature - dataValue = ((dataValue - 273.15) * slope) + offset + 273.15; - } else { - - dataValue = (dataValue * slope) + offset; - } - - calibMap[instance].isCalibrated = true; - boatDataValue->value = dataValue; - - calibrationData.smoothInstance(boatDataValue, logger); // smooth the boat data value - calibMap[instance].value = boatDataValue->value; // store the calibrated + smoothed value in the list - - logger->logDebug(GwLog::DEBUG, "BoatDataCalibration: %s: Offset: %f, Slope: %f, Result: %f", instance.c_str(), offset, slope, calibMap[instance].value); - } -} - -void CalibrationDataList::smoothInstance(GwApi::BoatValue* boatDataValue, GwLog* logger) -// Method to smoothen the boat data value -{ - static std::unordered_map lastValue; // array for last values of smoothed boat data values - - std::string instance = boatDataValue->getName().c_str(); - double oldValue = 0; - double dataValue = boatDataValue->value; - double smoothFactor = 0; - - if (!boatDataValue->valid) { // no valid boat data value, so we don't want to smoothen value - return; - } else if (calibMap.find(instance) == calibMap.end()) { - logger->logDebug(GwLog::DEBUG, "BoatDataCalibration: smooth factor for %s not found in calibration list", instance.c_str()); - return; - } else { - smoothFactor = calibMap[instance].smooth; - - if (lastValue.find(instance) != lastValue.end()) { - oldValue = lastValue[instance]; - dataValue = oldValue + (smoothFactor * (dataValue - oldValue)); // exponential smoothing algorithm - } - lastValue[instance] = dataValue; // store the new value for next cycle; first time, store only the current value and return - boatDataValue->value = dataValue; // set the smoothed value to the boat data value - } -} - -#endif diff --git a/lib/obp60task/BoatDataCalibration.h b/lib/obp60task/BoatDataCalibration.h deleted file mode 100644 index 9c05fc4..0000000 --- a/lib/obp60task/BoatDataCalibration.h +++ /dev/null @@ -1,33 +0,0 @@ -// Functions lib for data instance calibration - -#ifndef _BOATDATACALIBRATION_H -#define _BOATDATACALIBRATION_H - -#include "GwApi.h" -#include -#include - -#define MAX_CALIBRATION_DATA 3 // maximum number of calibration data instances - -typedef struct { - double offset; // calibration offset - double slope; // calibration slope - double smooth; // smoothing factor - double value; // calibrated data value - bool isCalibrated; // is data instance value calibrated? -} TypeCalibData; - -class CalibrationDataList { -public: - static std::unordered_map calibMap; // list of calibration data instances - - void readConfig(GwConfigHandler* config, GwLog* logger); - void calibrateInstance(GwApi::BoatValue* boatDataValue, GwLog* logger); - void smoothInstance(GwApi::BoatValue* boatDataValue, GwLog* logger); - -private: -}; - -extern CalibrationDataList calibrationData; // this list holds all calibration data - -#endif diff --git a/lib/obp60task/ImageDecoder.cpp b/lib/obp60task/ImageDecoder.cpp new file mode 100644 index 0000000..25783d2 --- /dev/null +++ b/lib/obp60task/ImageDecoder.cpp @@ -0,0 +1,23 @@ +#include "ImageDecoder.h" +#include + +// Decoder for Base64 content +bool ImageDecoder::decodeBase64(const char* base64, size_t base64Len, uint8_t* outBuffer, size_t outSize, size_t& decodedSize) { + if (base64 == nullptr) { + decodedSize = 0; + return false; + } + int ret = mbedtls_base64_decode( + outBuffer, + outSize, + &decodedSize, + (const unsigned char*)base64, + base64Len + ); + return (ret == 0); +} + +// Decoder for Base64 content +bool ImageDecoder::decodeBase64(const String& base64, uint8_t* outBuffer, size_t outSize, size_t& decodedSize) { + return decodeBase64(base64.c_str(), base64.length(), outBuffer, outSize, decodedSize); +} diff --git a/lib/obp60task/ImageDecoder.h b/lib/obp60task/ImageDecoder.h new file mode 100644 index 0000000..5bae456 --- /dev/null +++ b/lib/obp60task/ImageDecoder.h @@ -0,0 +1,10 @@ + +#pragma once +#include +#include + +class ImageDecoder { +public: + bool decodeBase64(const char* base64, size_t base64Len, uint8_t* outBuffer, size_t outSize, size_t& decodedSize); + bool decodeBase64(const String& base64, uint8_t* outBuffer, size_t outSize, size_t& decodedSize); +}; diff --git a/lib/obp60task/LedSpiTask.cpp b/lib/obp60task/LedSpiTask.cpp index ece26a2..f0e6ced 100644 --- a/lib/obp60task/LedSpiTask.cpp +++ b/lib/obp60task/LedSpiTask.cpp @@ -47,6 +47,8 @@ static uint8_t mulcolor(uint8_t f1, uint8_t f2){ } Color setBrightness(const Color &color,uint8_t brightness){ + if (brightness > 100) brightness = 100; + uint16_t br255=brightness*255; br255=br255/100; //very simple for now diff --git a/lib/obp60task/NetworkClient.cpp b/lib/obp60task/NetworkClient.cpp new file mode 100644 index 0000000..d4a1605 --- /dev/null +++ b/lib/obp60task/NetworkClient.cpp @@ -0,0 +1,593 @@ +#include "NetworkClient.h" +#include "GWWifi.h" // WiFi management (thread-safe) + +extern GwWifi gwWifi; // Extern declaration of global WiFi instance + +extern "C" { + #include "puff.h" +} + +static uint32_t crc32_update(uint32_t crc, const uint8_t* data, size_t len) { + crc = ~crc; + for (size_t i = 0; i < len; ++i) { + crc ^= data[i]; + for (int bit = 0; bit < 8; ++bit) { + uint32_t mask = -(int32_t)(crc & 1U); + crc = (crc >> 1) ^ (0xEDB88320U & mask); + } + } + return ~crc; +} + +// Constructor +NetworkClient::NetworkClient(size_t reserveSize) + : _doc(reserveSize), + _valid(false), + _jsonRaw(nullptr), + _jsonRawLen(0), + _imageWidth(0), + _imageHeight(0), + _numberPixels(0), + _pictureBase64(nullptr), + _pictureBase64Len(0) +{ +} + +NetworkClient::~NetworkClient() { + if (_jsonRaw != nullptr) { + free(_jsonRaw); + _jsonRaw = nullptr; + _jsonRawLen = 0; + } +} + +bool NetworkClient::findJsonIntField(const char* json, size_t len, const char* key, int& outValue) { + if (json == nullptr || key == nullptr || len == 0) { + return false; + } + + char pattern[64]; + int plen = snprintf(pattern, sizeof(pattern), "\"%s\"", key); + if (plen <= 0 || (size_t)plen >= sizeof(pattern)) { + return false; + } + + const char* keyPos = strstr(json, pattern); + if (keyPos == nullptr) { + return false; + } + + const char* end = json + len; + const char* colon = strchr(keyPos + plen, ':'); + if (colon == nullptr || colon >= end) { + return false; + } + + const char* p = colon + 1; + while (p < end && (*p == ' ' || *p == '\t' || *p == '\r' || *p == '\n')) { + ++p; + } + if (p >= end) { + return false; + } + + char* parseEnd = nullptr; + long value = strtol(p, &parseEnd, 10); + if (parseEnd == p) { + return false; + } + outValue = (int)value; + return true; +} + +bool NetworkClient::extractJsonStringInPlace(char* json, size_t len, const char* key, char*& outValue, size_t& outLen) { + outValue = nullptr; + outLen = 0; + + if (json == nullptr || key == nullptr || len == 0) { + return false; + } + + char pattern[64]; + int plen = snprintf(pattern, sizeof(pattern), "\"%s\"", key); + if (plen <= 0 || (size_t)plen >= sizeof(pattern)) { + return false; + } + + char* keyPos = strstr(json, pattern); + if (keyPos == nullptr) { + return false; + } + + char* end = json + len; + char* colon = strchr(keyPos + plen, ':'); + if (colon == nullptr || colon >= end) { + return false; + } + + char* p = colon + 1; + while (p < end && (*p == ' ' || *p == '\t' || *p == '\r' || *p == '\n')) { + ++p; + } + if (p >= end || *p != '"') { + return false; + } + + char* valueStart = p + 1; + char* cur = valueStart; + while (cur < end) { + if (*cur == '\\') { + ++cur; + if (cur < end) { + ++cur; + } + continue; + } + if (*cur == '"') { + *cur = '\0'; + outValue = valueStart; + outLen = (size_t)(cur - valueStart); + return true; + } + ++cur; + } + + return false; +} + +// Skip GZIP Header an goto DEFLATE content +int NetworkClient::skipGzipHeader(const uint8_t* data, size_t len) { + if (len < 10) return -1; + + if (data[0] != 0x1F || data[1] != 0x8B || data[2] != 8) { + return -1; + } + + size_t pos = 10; + uint8_t flags = data[3]; + + if (flags & 4) { + if (pos + 2 > len) return -1; + uint16_t xlen = data[pos] | (data[pos+1] << 8); + pos += 2 + xlen; + } + + if (flags & 8) { + while (pos < len && data[pos] != 0) pos++; + pos++; + } + + if (flags & 16) { + while (pos < len && data[pos] != 0) pos++; + pos++; + } + + if (flags & 2) pos += 2; + + if (pos >= len) return -1; + + return pos; +} + +// HTTP GET + GZIP Decompression (reading in chunks) +bool NetworkClient::httpGetGzip(const String& url, uint8_t*& outData, size_t& outLen) { + + const size_t capacity = READLIMIT; // Read limit for data (can be adjusted in NetworkClient.h) + uint8_t* buffer = (uint8_t*)malloc(capacity); + + // If not with WiFi connectetd then return without any activities + if (!gwWifi.clientConnected()) { + if (DEBUGING) {Serial.println("No WiFi connection");} + return false; + } + + // If frame buffer not correct allocated then return without any activities + if (!buffer) { + if (DEBUGING) {Serial.println("Malloc failed buffer");} + return false; + } + + HTTPClient http; + + // Timeouts to prevent hanging connections + http.setConnectTimeout(CONNECTIONTIMEOUT); // Connect timeout in ms (can be adjusted in NetworkClient.h) + http.setTimeout(TCPREADTIMEOUT); // Read timeout in ms (can be adjusted in NetworkClient.h) + + http.begin(url); + + // NEW: force server to close the connection after the response (prevents "stuck" keep-alive reads) + http.addHeader("Connection", "close"); + + // NEW: request gzip, but we will only decompress if the server actually answers with gzip + http.addHeader("Accept-Encoding", "gzip"); + + // NEW: register headers BEFORE GET() (more reliable with Arduino HTTPClient) + if (DEBUGING) { + // We need follow key words + const char* keys[] = { + "Content-Encoding", + "Transfer-Encoding", + "Content-Length" + }; + // Read header + http.collectHeaders(keys, 3); + } + + int code = http.GET(); + if (code != HTTP_CODE_OK) { + Serial.printf("HTTP Client ERROR: %d (%s)\n", code, http.errorToString(code).c_str()); + + // Hard reset HTTP + socket + WiFiClient* tmp = http.getStreamPtr(); + if (tmp) tmp->stop(); // Force close TCP socket + + http.end(); + free(buffer); + return false; + } + else{ + if (DEBUGING) { + String ce = http.header("Content-Encoding"); + String te = http.header("Transfer-Encoding"); + String cl = http.header("Content-Length"); + + // Print header informations + Serial.printf("Content-Encoding=%s Transfer-Encoding=%s Content-Length=%s\n", + ce.c_str(), + te.c_str(), + cl.c_str()); + } + } + + WiFiClient* stream = http.getStreamPtr(); + + size_t len = 0; + uint32_t lastData = millis(); + const uint32_t READ_TIMEOUT = READDATATIMEOUT; // Timeout for reading data (can be adjusted in NetworkClient.h) + + bool complete = false; + bool aborting = false; // NEW: remember if we must force-close socket + + // NEW: detect if server really sent gzip + String ce = http.header("Content-Encoding"); + bool isGzip = ce.equalsIgnoreCase("gzip"); + + // NEW: read expected body size if provided by server (prevents waiting forever for missing bytes) + int total = http.getSize(); // returns Content-Length, or -1 if unknown/chunked + + // NEW: fail fast if server claims something larger than our buffer + if (total > 0 && (size_t)total > capacity) { + Serial.println("Response exceeds READLIMIT."); + aborting = true; + } + + // NEW: if not gzip, we will not try to decompress (prevents false "Decompress OK" / random success) + // You can either handle plain JSON here or just fail-fast. + if (!isGzip && !aborting) { + if (DEBUGING) { + Serial.println("Server response is NOT gzip (Content-Encoding != gzip)."); + Serial.println("Either disable Accept-Encoding: gzip or add plain-body handling here."); + } + + // --- Plain-body handling (recommended): read full body into outData as-is --- + // NEW: try to read Content-Length bytes if available (more robust) + if (total > 0 && (size_t)total > capacity) { + Serial.println("Plain response exceeds READLIMIT."); + aborting = true; + } else { + // Read until we have all bytes (Content-Length) or until connection closes + buffer drains + while ((http.connected() || (stream && stream->available())) && !aborting) { + size_t avail = stream ? stream->available() : 0; + if (avail == 0) { + if (millis() - lastData > READ_TIMEOUT) { + Serial.println("TIMEOUT waiting for data (plain)!"); + aborting = true; + break; + } + delay(1); + continue; + } + + if (len >= capacity) { + Serial.println("READLIMIT reached, aborting (plain)."); + aborting = true; + break; + } + + if (len + avail > capacity) + avail = capacity - len; + + int read = stream->readBytes(buffer + len, avail); + if (read > 0) { + len += (size_t)read; + lastData = millis(); + } + + // NEW: stop reading as soon as we have the full response + if (total > 0 && (int)len >= total) { + break; // we got full body + } + } + } + + if (aborting) { + // --- Added: Force-close connection only if aborted to avoid TCP RST storms --- + if (stream) stream->stop(); // Force close TCP socket + http.end(); + free(buffer); + return false; + } + + if (total > 0 && (int)len != total) { + Serial.printf("Plain response incomplete: got=%d expected=%d\n", (int)len, total); + if (stream) stream->stop(); + http.end(); + free(buffer); + return false; + } + + // Return plain body to caller + outData = (uint8_t*)malloc(len + 1); + if (!outData) { + Serial.println("Malloc failed outData (plain)."); + // --- Added: Force-close connection only if aborted to avoid TCP RST storms --- + if (stream) stream->stop(); // Force close TCP socket + http.end(); + free(buffer); + return false; + } + memcpy(outData, buffer, len); + outData[len] = 0; + outLen = len; + + http.end(); + free(buffer); + return true; + } + + // --- GZIP path (only if Content-Encoding is gzip) --- + if (!aborting) { + + // NEW: read exactly Content-Length bytes when available (prevents partial-body timeout loops) + while ((http.connected() || (stream && stream->available())) && !complete && !aborting) { + + size_t avail = stream ? stream->available() : 0; + + if (avail == 0) { + // NEW: if Content-Length is known and we already read it all, stop immediately + if (total > 0 && (int)len >= total) { + break; + } + + if (millis() - lastData > READ_TIMEOUT) { + Serial.println("TIMEOUT waiting for data!"); + aborting = true; // NEW: mark abnormal exit + break; + } + delay(1); + continue; + } + + // NEW: safety check if buffer limit is reached + if (len >= capacity) { + Serial.println("READLIMIT reached, aborting."); + aborting = true; + break; + } + + // NEW: if Content-Length is known, do not read beyond it + if (total > 0) { + size_t remaining = (size_t)total - len; + if (avail > remaining) avail = remaining; + } + + if (len + avail > capacity) + avail = capacity - len; + + int read = stream->readBytes(buffer + len, avail); + if (read <= 0) { + // NEW: avoid tight loop if read returns zero + delay(1); + continue; + } + + len += (size_t)read; + lastData = millis(); + + if (DEBUGING) {Serial.printf("Read chunk: %d (total: %d)\n", read, (int)len);} + + // NEW: if Content-Length is known and fully received, we can stop reading + if (total > 0 && (int)len >= total) { + break; + } + } + + // NEW: only attempt gzip parse/decompress after we have a complete body (when Content-Length is known) + // This avoids wasting heap with repeated malloc/free and reduces fragmentation over long runtimes. + if (!aborting) { + if (total > 0 && (int)len != total) { + Serial.printf("GZIP response incomplete: got=%d expected=%d\n", (int)len, total); + aborting = true; + } + } + + if (!aborting) { + if (len < 20) { + aborting = true; + } else { + int headerOffset = skipGzipHeader(buffer, len); + if (headerOffset < 0) { + aborting = true; + } else { + size_t deflateLen = len - (size_t)headerOffset; + // GZIP trailer (CRC32 + ISIZE) is 8 bytes and not part of deflate stream. + if (deflateLen >= 8) { + deflateLen -= 8; + } + + unsigned long srcLenForSize = (unsigned long)deflateLen; + unsigned long outNeeded = 0; + int sizeRes = puff(NIL, &outNeeded, buffer + headerOffset, &srcLenForSize); + + if (sizeRes != 0) { + if (DEBUGING) { + Serial.printf("Decompress size probe failed: res=%d src=%lu\n", sizeRes, srcLenForSize); + } + aborting = true; + } else { + uint8_t* test = (uint8_t*)malloc((size_t)outNeeded + 1); + if (!test) { + Serial.println("Malloc failed test buffer, aborting."); + aborting = true; + } else { + unsigned long srcLen = (unsigned long)deflateLen; + unsigned long testLen = outNeeded; + int res = puff(test, &testLen, buffer + headerOffset, &srcLen); + + if (res == 0) { + uint32_t trailerCrc = + (uint32_t)buffer[len - 8] | + ((uint32_t)buffer[len - 7] << 8) | + ((uint32_t)buffer[len - 6] << 16) | + ((uint32_t)buffer[len - 5] << 24); + uint32_t trailerIsize = + (uint32_t)buffer[len - 4] | + ((uint32_t)buffer[len - 3] << 8) | + ((uint32_t)buffer[len - 2] << 16) | + ((uint32_t)buffer[len - 1] << 24); + uint32_t calcCrc = crc32_update(0, test, (size_t)testLen); + uint32_t calcIsize = (uint32_t)testLen; + + if (calcCrc != trailerCrc || calcIsize != trailerIsize) { + Serial.printf( + "GZIP CRC/ISIZE mismatch crc=%08lx/%08lx isize=%lu/%lu\n", + (unsigned long)calcCrc, + (unsigned long)trailerCrc, + (unsigned long)calcIsize, + (unsigned long)trailerIsize + ); + free(test); + aborting = true; + } else { + test[testLen] = 0; + if (DEBUGING) {Serial.printf("Decompress OK! Size: %lu bytes\n", testLen);} + outData = test; + outLen = (size_t)testLen; + complete = true; + } + } else { + if (DEBUGING) { + Serial.printf("Decompress failed: res=%d out=%lu src=%lu\n", res, testLen, srcLen); + } + free(test); + aborting = true; + } + } + } + } + } + } + } + + // --- Added: Force-close connection only if aborted to avoid TCP RST storms --- + if (aborting && stream) stream->stop(); // NEW: stop() only on abnormal termination + + http.end(); + free(buffer); + + if (!complete) { + Serial.println("Failed to complete decompress."); + return false; + } + + return true; +} + +// Decompress JSON +bool NetworkClient::fetchAndDecompressJson(const String& url) { + + _valid = false; + _doc.clear(); + _imageWidth = 0; + _imageHeight = 0; + _numberPixels = 0; + _pictureBase64 = nullptr; + _pictureBase64Len = 0; + + if (_jsonRaw != nullptr) { + free(_jsonRaw); + _jsonRaw = nullptr; + _jsonRawLen = 0; + } + + uint8_t* raw = nullptr; + size_t rawLen = 0; + + if (!httpGetGzip(url, raw, rawLen)) { + Serial.println("GZIP download/decompress failed."); + return false; + } + + char* json = reinterpret_cast(raw); + bool ok = true; + ok = findJsonIntField(json, rawLen, "number_pixels", _numberPixels) && ok; + ok = findJsonIntField(json, rawLen, "width", _imageWidth) && ok; + ok = findJsonIntField(json, rawLen, "height", _imageHeight) && ok; + ok = extractJsonStringInPlace(json, rawLen, "picture_base64", _pictureBase64, _pictureBase64Len) && ok; + + if (!ok) { + Serial.println("JSON field extraction failed."); + free(raw); + return false; + } + + if (_imageWidth <= 0 || _imageHeight <= 0 || _pictureBase64Len == 0) { + Serial.printf("JSON invalid geometry/data w=%d h=%d b64=%u\n", + _imageWidth, + _imageHeight, + (unsigned int)_pictureBase64Len); + free(raw); + return false; + } + + _jsonRaw = raw; + _jsonRawLen = rawLen; + + if (DEBUGING) { + Serial.printf("JSON fields OK: num=%d w=%d h=%d b64=%u\n", + _numberPixels, + _imageWidth, + _imageHeight, + (unsigned int)_pictureBase64Len); + } + _valid = true; + return true; +} + +JsonDocument& NetworkClient::json() { + return _doc; +} + +int NetworkClient::imageWidth() const { + return _imageWidth; +} + +int NetworkClient::imageHeight() const { + return _imageHeight; +} + +int NetworkClient::numberPixels() const { + return _numberPixels; +} + +const char* NetworkClient::pictureBase64() const { + return _pictureBase64; +} + +size_t NetworkClient::pictureBase64Len() const { + return _pictureBase64Len; +} + +bool NetworkClient::isValid() const { + return _valid; +} diff --git a/lib/obp60task/NetworkClient.h b/lib/obp60task/NetworkClient.h new file mode 100644 index 0000000..a04bf1f --- /dev/null +++ b/lib/obp60task/NetworkClient.h @@ -0,0 +1,42 @@ +#pragma once +#include +#include +#include + +#define DEBUGING true // Debug flag for NetworkClient for more live information +#define READLIMIT 200000 // HTTP read limit in byte for gzip content (can be adjusted) +#define CONNECTIONTIMEOUT 3000 // Timeout in ms for HTTP connection +#define TCPREADTIMEOUT 2000 // Timeout in ms for read HTTP client stack +#define READDATATIMEOUT 2000 // Timeout in ms for read data + +class NetworkClient { +public: + NetworkClient(size_t reserveSize = 0); + ~NetworkClient(); + + bool fetchAndDecompressJson(const String& url); + JsonDocument& json(); + int imageWidth() const; + int imageHeight() const; + int numberPixels() const; + const char* pictureBase64() const; + size_t pictureBase64Len() const; + bool isValid() const; + +private: + DynamicJsonDocument _doc; + bool _valid; + uint8_t* _jsonRaw; + size_t _jsonRawLen; + int _imageWidth; + int _imageHeight; + int _numberPixels; + char* _pictureBase64; + size_t _pictureBase64Len; + + int skipGzipHeader(const uint8_t* data, size_t len); + bool httpGetGzip(const String& url, uint8_t*& outData, size_t& outLen); + static bool findJsonIntField(const char* json, size_t len, const char* key, int& outValue); + static bool extractJsonStringInPlace(char* json, size_t len, const char* key, char*& outValue, size_t& outLen); +}; + diff --git a/lib/obp60task/OBP60Extensions.cpp b/lib/obp60task/OBP60Extensions.cpp index e1ccc1f..3d294c8 100644 --- a/lib/obp60task/OBP60Extensions.cpp +++ b/lib/obp60task/OBP60Extensions.cpp @@ -2,9 +2,9 @@ #if defined BOARD_OBP60S3 || defined BOARD_OBP40S3 #include -#include // Driver for PCF8574 output modul from Horter #include // I2C #include // Driver for DS1388 RTC +#include // PCF8574 modules from Horter #include "SunRise.h" // Lib for sunrise and sunset calculation #include "Pagedata.h" #include "OBP60Hardware.h" @@ -26,6 +26,7 @@ #include "fonts/Ubuntu_Bold32pt8b.h" #include "fonts/Atari16px8b.h" // Key label font #include "fonts/Atari6px8b.h" // Very small (6x6) font +#include "fonts/IBM8x8px.h" // E-Ink Display #define GxEPD_WIDTH 400 // Display width @@ -50,7 +51,7 @@ GxEPD2_BW display(GxEPD2_4 gxepd2display *epd = &display; // Horter I2C moduls -PCF8574 pcf8574_Out(PCF8574_I2C_ADDR1); // First digital output modul PCF8574 from Horter +PCF8574 pcf8574_Modul1(PCF8574_I2C_ADDR1); // First digital IO modul PCF8574 from Horter // FRAM Adafruit_FRAM_I2C fram; @@ -82,10 +83,11 @@ void hardwareInit(GwApi *api) Wire.begin(); // Init PCF8574 digital outputs - Wire.setClock(I2C_SPEED); // Set I2C clock as defined - if(pcf8574_Out.begin()){ // Initialize PCF8574 - pcf8574_Out.write8(255); // Clear all outputs + Wire.setClock(I2C_SPEED_LOW); // Set I2C clock to low for external devices + if (pcf8574_Modul1.begin()) { // Initialize PCF8574 + pcf8574_Modul1.write8(255); // Clear all outputs (low activ) } + Wire.setClock(I2C_SPEED); // Set I2C clock to normal fram = Adafruit_FRAM_I2C(); if (esp_reset_reason() == ESP_RST_POWERON) { // help initialize FRAM @@ -186,6 +188,28 @@ void powerInit(String powermode) { } } +void setPCF8574PortPinModul1(uint8_t pin, uint8_t value) +{ + static bool firstRunFinished; + static uint8_t port1; // Retained data for port bits + // If fisrt run then set all outputs to low + if(firstRunFinished == false){ + port1 = 255; // Low active + firstRunFinished = true; + } + if (pin > 7) return; + Wire.setClock(I2C_SPEED_LOW); // Set I2C clock on 10 kHz for longer wires + // Set bit + if (pcf8574_Modul1.begin(port1)) // Check module availability and start it + { + if (value == LOW) port1 &= ~(1 << pin); // Set bit + else port1 |= (1 << pin); + pcf8574_Modul1.write8(port1); // Write byte + } + Wire.setClock(I2C_SPEED); // Set I2C clock on 100 kHz +} + + void setPortPin(uint pin, bool value){ pinMode(pin, OUTPUT); digitalWrite(pin, value); @@ -302,8 +326,46 @@ void toggleBacklightLED(uint brightness, const Color &color) { ledTaskData->setLedData(current); } +void stepsBacklightLED(uint brightness, const Color &color) { + static uint step = 0; + uint actBrightness = 0; + // Different brightness steps + if (step == 0){ + actBrightness = brightness; // 100% from brightness + statusBacklightLED = true; + } + else if (step == 1) { + actBrightness = brightness * 0.5; // 50% from brighntess + statusBacklightLED = true; + } + else if (step == 2) { + actBrightness = brightness * 0.2; // 20% from brightness + statusBacklightLED = true; + } + else if (step == 3) { + actBrightness = 0; // 0% + statusBacklightLED = false; + } + if (actBrightness < 5) { // Limiter if values too low + actBrightness = 5; + } + step = step + 1; // Increment step counter + if (step == 4) { // Reset counter + step = 0; + } + if (ledTaskData == nullptr) { + return; + } + Color nv = setBrightness(statusBacklightLED ? color:COLOR_BLACK, actBrightness); + LedInterface current = ledTaskData->getLedData(); + current.setBacklight(nv); + ledTaskData->setLedData(current); +} + void setFlashLED(bool status) { - if (ledTaskData == nullptr) return; + if (ledTaskData == nullptr) { + return; + } Color c = status ? COLOR_RED : COLOR_BLACK; LedInterface current = ledTaskData->getLedData(); current.setFlash(c); @@ -424,6 +486,27 @@ void drawTextCenter(int16_t cx, int16_t cy, String text) { epd->print(text); } +// Draw centered botton with centered text +void drawButtonCenter(int16_t cx, int16_t cy, int8_t sx, int8_t sy, String text, uint16_t fg, uint16_t bg, bool inverted) { + int16_t x1, y1; + uint16_t w, h; + epd->getTextBounds(text, 0, 150, &x1, &y1, &w, &h); + int16_t cursorX = cx - (x1 + static_cast(w / 2)); + int16_t cursorY = cy - (y1 + static_cast(h / 2)); + //epd->drawPixel(cx, cy, fg); // Debug pixel for center position + if (inverted) { + epd->fillRoundRect(cx - sx / 2, cy - sy / 2, sx, sy, 5, fg); + epd->setTextColor(bg); + epd->setCursor(cursorX, cursorY); + epd->print(text); + } else { + epd->drawRoundRect(cx - sx / 2, cy - sy / 2, sx, sy, 5, fg); // Draw button + epd->setTextColor(fg); + epd->setCursor(cursorX, cursorY); + epd->print(text); + } +} + // Draw right aligned text void drawTextRalign(int16_t x, int16_t y, String text) { int16_t x1, y1; @@ -892,6 +975,79 @@ void generatorGraphic(uint x, uint y, int pcolor, int bcolor){ epd->print("G"); } +// Display rudder position as horizontal bargraph with configurable +/- range (degrees) +void displayRudderPosition(int rudderPosition, uint8_t rangeDeg, uint16_t cx, uint16_t cy, uint16_t fg, uint16_t bg) { + const int w = 360; + const int h = 20; + const int t = 3; // Line thickness + const int halfw = w/2; + const int halfh = h/2; + // Calculate top-left of bar (cx,cy are center of 0°) + int left = int(cx) - halfw; + int top = int(cy) - halfh; + + // clamp provided range to allowed bounds [10,45] + if (rangeDeg < 10) { + rangeDeg = 10; + } else if (rangeDeg > 45) { + rangeDeg = 45; + } + + // Pixels per degree for +/-rangeDeg -> total span = 2*rangeDeg + const float pxPerDeg = float(w) / (2.0f * float(rangeDeg)); + + // Draw outer border (thickness t) + for (int i = 0; i < t; i++) { + epd->drawRect(left + i, top + i, w - 2 * i, h - 2 * i, fg); + } + + // Fill inner area with background + epd->fillRect(left + t, top + t, w - 2 * t, h - 2 * t, bg); + + // Draw center line + epd->drawRect(cx - 1, top + 1, 3 , h - 2, fg); + + // Clamp rudder position to -rangeDeg..rangeDeg + if (rudderPosition > (int)rangeDeg) { + rudderPosition = (int)rangeDeg; + } else if (rudderPosition < -((int)rangeDeg)) { + rudderPosition = -((int)rangeDeg); + } + + // Compute fill width in pixels + int fillPx = int(round(rudderPosition * pxPerDeg)); // positive -> right + + // Fill area from center to position (if non-zero) + int centerx = cx; + int innerTop = top + t; + int innerH = h - 2 * t; + if (fillPx > 0) { + // Right side + epd->fillRect(centerx, innerTop, fillPx, innerH, fg); + } else if (fillPx < 0) { + // Left side + epd->fillRect(centerx + fillPx, innerTop, -fillPx, innerH, fg); + } + + // Draw tick marks every 5° and labels outside the bar + epd->setTextColor(fg); + epd->setFont(&Ubuntu_Bold8pt8b); + for (int angle = -((int)rangeDeg); angle <= (int)rangeDeg; angle += 5) { + int xpos = int(round(centerx + angle * pxPerDeg)); + // Vertical tick inside bar + epd->drawLine(xpos, top, xpos, top + h + 2, fg); + // Label outside: below the bar + String lbl = String(angle); + int16_t bx, by; + uint16_t bw, bh; + epd->getTextBounds(lbl, 0, 0, &bx, &by, &bw, &bh); + int16_t tx = xpos - bw/2; + int16_t ty = top + h + bh + 5; // A little spacing + epd->setCursor(tx, ty); + epd->print(lbl); + } +} + // Function to handle HTTP image request // http://192.168.15.1/api/user/OBP60Task/screenshot void doImageRequest(GwApi *api, int *pageno, const PageStruct pages[MAX_PAGE_NUMBER], AsyncWebServerRequest *request) { diff --git a/lib/obp60task/OBP60Extensions.h b/lib/obp60task/OBP60Extensions.h index 98e6fa5..31bb298 100644 --- a/lib/obp60task/OBP60Extensions.h +++ b/lib/obp60task/OBP60Extensions.h @@ -87,13 +87,14 @@ uint8_t getLastPage(); void hardwareInit(GwApi *api); void powerInit(String powermode); +void setPCF8574PortPinModul1(uint8_t pin, uint8_t value);// Set PCF8574 port pin void setPortPin(uint pin, bool value); // Set port pin for extension port - void togglePortPin(uint pin); // Toggle extension port pin Color colorMapping(const String &colorString); // Color mapping string to CHSV colors void setBacklightLED(uint brightness, const Color &color);// Set backlight LEDs void toggleBacklightLED(uint brightness,const Color &color);// Toggle backlight LEDs +void stepsBacklightLED(uint brightness, const Color &color);// Set backlight LEDs in 4 steps (100%, 50%, 10%, 0%) BacklightMode backlightMapping(const String &backlightString);// Configuration string to value void setFlashLED(bool status); // Set flash LED @@ -106,6 +107,7 @@ void setBuzzerPower(uint power); // Set buzzer power String xdrDelete(String input, uint8_t maxlen = 0); // Delete xdr prefix from string and optional limit length void drawTextCenter(int16_t cx, int16_t cy, String text); +void drawButtonCenter(int16_t cx, int16_t cy, int8_t sx, int8_t sy, String text, uint16_t fg, uint16_t bg, bool inverted); void drawTextRalign(int16_t x, int16_t y, String text); void drawTextBoxed(Rect box, String text, uint16_t fg, uint16_t bg, bool inverted, bool border); @@ -124,6 +126,10 @@ void solarGraphic(uint x, uint y, int pcolor, int bcolor); // S void generatorGraphic(uint x, uint y, int pcolor, int bcolor); // Generator graphic void startLedTask(GwApi *api); +// Display rudder position as horizontal bargraph with configurable +/- range (degrees) +// 'rangeDeg' is unsigned and will be clamped to [10,45] +void displayRudderPosition(int rudderPosition, uint8_t rangeDeg, uint16_t cx, uint16_t cy, uint16_t fg, uint16_t bg); + void doImageRequest(GwApi *api, int *pageno, const PageStruct pages[MAX_PAGE_NUMBER], AsyncWebServerRequest *request); // Icons diff --git a/lib/obp60task/OBP60Formatter.cpp b/lib/obp60task/OBP60Formatter.cpp index 795dfbc..815f402 100644 --- a/lib/obp60task/OBP60Formatter.cpp +++ b/lib/obp60task/OBP60Formatter.cpp @@ -67,14 +67,23 @@ fmtTime Formatter::getTimeFormat(String sformat) { return fmtTime::MMHH; // default } -FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &commondata){ +FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &commondata, bool ignoreSimuDataSetting) { GwLog *logger = commondata.logger; FormattedData result; static int dayoffset = 0; double rawvalue = 0; + bool simulation; + if (ignoreSimuDataSetting) { + simulation = false; // ignore user setting for simulation data; we want to format the boat value passed to this function + } else { + simulation = usesimudata; // use setting from configuration + } + + result.cvalue = value->value; + // If boat value not valid - if (! value->valid && !usesimudata){ + if (! value->valid && !simulation){ result.svalue = placeholder; return result; } @@ -98,7 +107,7 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common tmElements_t parts; time_t tv=tNMEA0183Msg::daysToTime_t(value->value + dayoffset); tNMEA0183Msg::breakTime(tv,parts); - if (usesimudata == false) { + if (simulation == false) { if (String(dateFormat) == "DE") { snprintf(buffer,bsize, "%02d.%02d.%04d", parts.tm_mday, parts.tm_mon+1, parts.tm_year+1900); } @@ -132,11 +141,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common if (timeInSeconds > 86400) {timeInSeconds = timeInSeconds - 86400;} if (timeInSeconds < 0) {timeInSeconds = timeInSeconds + 86400;} // LOG_DEBUG(GwLog::DEBUG,"... formatTime value: %f tz: %f corrected timeInSeconds: %f ", value->value, timeZone, timeInSeconds); - if (usesimudata == false) { + if (simulation == false) { val = modf(timeInSeconds/3600.0, &inthr); val = modf(val*3600.0/60.0, &intmin); modf(val*60.0,&intsec); snprintf(buffer, bsize, "%02.0f:%02.0f:%02.0f", inthr, intmin, intsec); + result.cvalue = timeInSeconds; } else{ static long sec; @@ -146,13 +156,14 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common } sec = sec % 60; snprintf(buffer, bsize, "11:36:%02i", int(sec)); + result.cvalue = sec; lasttime = millis(); } result.unit = ((timeZone == 0) ? "UTC" : "LOT"); } //######################################################## else if (value->getFormat() == "formatFixed0"){ - if(usesimudata == false) { + if(simulation == false) { snprintf(buffer, bsize, "%3.0f", value->value); rawvalue = value->value; } @@ -161,16 +172,17 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common snprintf(buffer, bsize, "%3.0f", rawvalue); } result.unit = ""; + result.cvalue = rawvalue; } //######################################################## else if (value->getFormat() == "formatCourse" || value->getFormat() == "formatWind"){ double course = 0; - if (usesimudata == false) { + if (simulation == false) { course = value->value; rawvalue = value->value; } else { - course = 2.53 + float(random(0, 10) / 100.0); + course = M_PI_2 + float(random(-17, 17) / 100.0); // create random course/wind values with 90° +/- 10° rawvalue = course; } course = course * 57.2958; // Unit conversion form rad to deg @@ -178,16 +190,17 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common // Format 3 numbers with prefix zero snprintf(buffer,bsize,"%03.0f",course); result.unit = "Deg"; + result.cvalue = course; } //######################################################## else if (value->getFormat() == "formatKnots" && (value->getName() == "SOG" || value->getName() == "STW")){ double speed = 0; - if (usesimudata == false) { + if (simulation == false) { speed = value->value; rawvalue = value->value; } else{ - rawvalue = 4.0 + float(random(0, 40)); + rawvalue = 4.0 + float(random(-30, 40) / 10.0); // create random speed values from [1..8] m/s speed = rawvalue; } if (String(speedFormat) == "km/h"){ @@ -211,16 +224,17 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common else { snprintf(buffer, bsize, fmt_dec_100, speed); } + result.cvalue = speed; } //######################################################## else if (value->getFormat() == "formatKnots" && (value->getName() == "AWS" || value->getName() == "TWS" || value->getName() == "MaxAws" || value->getName() == "MaxTws")){ double speed = 0; - if (usesimudata == false) { + if (simulation == false) { speed = value->value; rawvalue = value->value; } else { - rawvalue = 4.0 + float(random(0, 40)); + rawvalue = 4.0 + float(random(0, 40) / 10.0); // create random wind speed values from [4..8] m/s speed = rawvalue; } if (String(windspeedFormat) == "km/h"){ @@ -291,11 +305,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common snprintf(buffer, bsize, fmt_dec_100, speed); } } + result.cvalue = speed; } //######################################################## else if (value->getFormat() == "formatRot"){ double rotation = 0; - if (usesimudata == false) { + if (simulation == false) { rotation = value->value; rawvalue = value->value; } @@ -317,11 +332,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common else { snprintf(buffer, bsize, "%3.0f", rotation); } + result.cvalue = rotation; } //######################################################## else if (value->getFormat() == "formatDop"){ double dop = 0; - if (usesimudata == false) { + if (simulation == false) { dop = value->value; rawvalue = value->value; } @@ -342,10 +358,11 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common else { snprintf(buffer, bsize, fmt_dec_100, dop); } + result.cvalue = dop; } //######################################################## else if (value->getFormat() == "formatLatitude"){ - if (usesimudata == false) { + if (simulation == false) { double lat = value->value; rawvalue = value->value; String latitude = ""; @@ -361,10 +378,11 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common rawvalue = 35.0 + float(random(0, 10)) / 10000.0; snprintf(buffer, bsize, " 51\" %2.4f' N", rawvalue); } + result.cvalue = rawvalue; } //######################################################## else if (value->getFormat() == "formatLongitude"){ - if (usesimudata == false) { + if (simulation == false) { double lon = value->value; rawvalue = value->value; String longitude = ""; @@ -380,16 +398,17 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common rawvalue = 6.0 + float(random(0, 10)) / 100000.0; snprintf(buffer, bsize, " 15\" %2.4f'", rawvalue); } + result.cvalue = rawvalue; } //######################################################## else if (value->getFormat() == "formatDepth"){ double depth = 0; - if (usesimudata == false) { + if (simulation == false) { depth = value->value; rawvalue = value->value; } else { - rawvalue = 18.0 + float(random(0, 100)) / 10.0; + rawvalue = 18.0 + float(random(0, 100)) / 10.0; // create random depth values from [18..28] metres depth = rawvalue; } if(String(lengthFormat) == "ft"){ @@ -408,11 +427,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common else { snprintf(buffer, bsize, fmt_dec_100, depth); } + result.cvalue = depth; } //######################################################## else if (value->getFormat() == "formatXte"){ double xte = 0; - if (usesimudata == false) { + if (simulation == false) { xte = value->value; rawvalue = value->value; } else { @@ -436,11 +456,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common else { snprintf(buffer, bsize, "%3.0f", xte); } + result.cvalue = xte; } //######################################################## else if (value->getFormat() == "kelvinToC"){ double temp = 0; - if (usesimudata == false) { + if (simulation == false) { temp = value->value; rawvalue = value->value; } @@ -468,11 +489,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common else { snprintf(buffer, bsize, fmt_dec_100, temp); } + result.cvalue = temp; } //######################################################## else if (value->getFormat() == "mtr2nm"){ double distance = 0; - if (usesimudata == false) { + if (simulation == false) { distance = value->value; rawvalue = value->value; } @@ -500,6 +522,7 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common else { snprintf(buffer, bsize, fmt_dec_100, distance); } + result.cvalue = distance; } //######################################################## // Special XDR formats @@ -507,7 +530,7 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common //######################################################## else if (value->getFormat() == "formatXdr:P:P"){ double pressure = 0; - if (usesimudata == false) { + if (simulation == false) { pressure = value->value; rawvalue = value->value; pressure = pressure / 100.0; // Unit conversion form Pa to hPa @@ -518,11 +541,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common } snprintf(buffer, bsize, "%4.0f", pressure); result.unit = "hPa"; + result.cvalue = pressure; } //######################################################## else if (value->getFormat() == "formatXdr:P:B"){ double pressure = 0; - if (usesimudata == false) { + if (simulation == false) { pressure = value->value; rawvalue = value->value; pressure = pressure / 100.0; // Unit conversion form Pa to mBar @@ -533,11 +557,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common } snprintf(buffer, bsize, "%4.0f", pressure); result.unit = "mBar"; + result.cvalue = pressure; } //######################################################## else if (value->getFormat() == "formatXdr:U:V"){ double voltage = 0; - if (usesimudata == false) { + if (simulation == false) { voltage = value->value; rawvalue = value->value; } @@ -552,11 +577,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common snprintf(buffer, bsize, fmt_dec_10, voltage); } result.unit = "V"; + result.cvalue = voltage; } //######################################################## else if (value->getFormat() == "formatXdr:I:A"){ double current = 0; - if (usesimudata == false) { + if (simulation == false) { current = value->value; rawvalue = value->value; } @@ -574,11 +600,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common snprintf(buffer, bsize, fmt_dec_100, current); } result.unit = "A"; + result.cvalue = current; } //######################################################## else if (value->getFormat() == "formatXdr:C:K"){ double temperature = 0; - if (usesimudata == false) { + if (simulation == false) { temperature = value->value - 273.15; // Convert K to C rawvalue = value->value - 273.15; } @@ -596,11 +623,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common snprintf(buffer, bsize, fmt_dec_100, temperature); } result.unit = "Deg C"; + result.cvalue = temperature; } //######################################################## else if (value->getFormat() == "formatXdr:C:C"){ double temperature = 0; - if (usesimudata == false) { + if (simulation == false) { temperature = value->value; // Value in C rawvalue = value->value; } @@ -618,11 +646,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common snprintf(buffer, bsize, fmt_dec_100, temperature); } result.unit = "Deg C"; + result.cvalue = temperature; } //######################################################## else if (value->getFormat() == "formatXdr:H:P"){ double humidity = 0; - if (usesimudata == false) { + if (simulation == false) { humidity = value->value; // Value in % rawvalue = value->value; } @@ -640,11 +669,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common snprintf(buffer, bsize, fmt_dec_100, humidity); } result.unit = "%"; + result.cvalue = humidity; } //######################################################## else if (value->getFormat() == "formatXdr:V:P"){ double volume = 0; - if (usesimudata == false) { + if (simulation == false) { volume = value->value; // Value in % rawvalue = value->value; } @@ -662,11 +692,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common snprintf(buffer, bsize, fmt_dec_100, volume); } result.unit = "%"; + result.cvalue = volume; } //######################################################## else if (value->getFormat() == "formatXdr:V:M"){ double volume = 0; - if (usesimudata == false) { + if (simulation == false) { volume = value->value; // Value in l rawvalue = value->value; } @@ -684,11 +715,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common snprintf(buffer, bsize, fmt_dec_100, volume); } result.unit = "l"; + result.cvalue = volume; } //######################################################## else if (value->getFormat() == "formatXdr:R:I"){ double flow = 0; - if (usesimudata == false) { + if (simulation == false) { flow = value->value; // Value in l/min rawvalue = value->value; } @@ -706,11 +738,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common snprintf(buffer, bsize, fmt_dec_100, flow); } result.unit = "l/min"; + result.cvalue = flow; } //######################################################## else if (value->getFormat() == "formatXdr:G:"){ double generic = 0; - if (usesimudata == false) { + if (simulation == false) { generic = value->value; rawvalue = value->value; } @@ -728,11 +761,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common snprintf(buffer, bsize, fmt_dec_100, generic); } result.unit = ""; + result.cvalue = generic; } //######################################################## else if (value->getFormat() == "formatXdr:A:P"){ double dplace = 0; - if (usesimudata == false) { + if (simulation == false) { dplace = value->value; // Value in % rawvalue = value->value; } @@ -750,11 +784,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common snprintf(buffer, bsize, fmt_dec_100, dplace); } result.unit = "%"; + result.cvalue = dplace; } //######################################################## - else if (value->getFormat() == "formatXdr:A:D"){ + else if ((value->getFormat() == "formatXdr:A:D") || ((value->getFormat() == "formatXdr:A:rd"))){ double angle = 0; - if (usesimudata == false) { + if (simulation == false) { angle = value->value; angle = angle * 57.2958; // Unit conversion form rad to deg rawvalue = value->value; @@ -770,11 +805,12 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common snprintf(buffer,bsize,"%3.0f",angle); } result.unit = "Deg"; + result.cvalue = angle; } //######################################################## else if (value->getFormat() == "formatXdr:T:R"){ double rpm = 0; - if (usesimudata == false) { + if (simulation == false) { rpm = value->value; // Value in rpm rawvalue = value->value; } @@ -792,6 +828,7 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common snprintf(buffer, bsize, fmt_dec_100, rpm); } result.unit = "rpm"; + result.cvalue = rpm; } //######################################################## // Default format @@ -807,6 +844,7 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common snprintf(buffer, bsize, fmt_dec_100, value->value); } result.unit = ""; + result.cvalue = value->value; } buffer[bsize] = 0; result.value = rawvalue; // Return value is only necessary in case of simulation of graphic pointer @@ -814,6 +852,37 @@ FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &common return result; } +// Convert and format boat value from SI to user defined format (definition for compatibility purposes) +FormattedData Formatter::formatValue(GwApi::BoatValue *value, CommonData &commondata) { + return formatValue(value, commondata, false); // call with standard handling of user setting for simulation data +} + +// Helper method for conversion of any data value from SI to user defined format +double Formatter::convertValue(const double &value, const String &name, const String &format, CommonData &commondata) +{ + std::unique_ptr tmpBValue; // Temp variable to get converted data value from + double result; // data value converted to user defined target data format + constexpr bool NO_SIMUDATA = true; // switch off simulation feature of function + + // prepare temporary BoatValue structure for use in + tmpBValue = std::unique_ptr(new GwApi::BoatValue(name)); // we don't need boat value name for pure value conversion + tmpBValue->setFormat(format); + tmpBValue->valid = true; + tmpBValue->value = value; + + result = formatValue(tmpBValue.get(), commondata, NO_SIMUDATA).cvalue; // get value (converted); ignore any simulation data setting + return result; +} + +// Helper method for conversion of any data value from SI to user defined format +double Formatter::convertValue(const double &value, const String &format, CommonData &commondata) +{ + double result; // data value converted to user defined target data format + + result = convertValue(value, "dummy", format, commondata); + return result; +} + String formatDate(fmtDate fmttype, uint16_t year, uint8_t month, uint8_t day) { char buffer[12]; if (fmttype == fmtDate::GB) { diff --git a/lib/obp60task/OBP60Formatter.h b/lib/obp60task/OBP60Formatter.h index 79cdeac..20838f5 100644 --- a/lib/obp60task/OBP60Formatter.h +++ b/lib/obp60task/OBP60Formatter.h @@ -130,9 +130,10 @@ enum class fmtTemp {KELVIN, CELSUIS, FAHRENHEIT}; // Structure for formatted boat values typedef struct { - double value; - String svalue; - String unit; + double value; // SI value of boat data value + double cvalue; // value converted to target unit + String svalue; // value converted to target unit and formatted + String unit; // target value unit } FormattedData; // Formatter for boat values @@ -159,7 +160,10 @@ public: fmtType stringToFormat(const char* formatStr); fmtDate getDateFormat(String sformat); fmtTime getTimeFormat(String sformat); + FormattedData formatValue(GwApi::BoatValue *value, CommonData &commondata, bool ignoreSimuDataSetting); FormattedData formatValue(GwApi::BoatValue *value, CommonData &commondata); + double convertValue(const double &value, const String &name, const String &format, CommonData &commondata); + double convertValue(const double &value, const String &format, CommonData &commondata); String placeholder = "---"; }; diff --git a/lib/obp60task/OBP60Hardware.h b/lib/obp60task/OBP60Hardware.h index ac366c8..d38ea9b 100644 --- a/lib/obp60task/OBP60Hardware.h +++ b/lib/obp60task/OBP60Hardware.h @@ -1,11 +1,12 @@ // General hardware definitions // CAN and RS485 bus pin definitions see obp60task.h -#ifdef HARDWARE_V21 +#if defined HARDWARE_V20 || HARDWARE_V21 // Direction pin for RS485 NMEA0183 #define OBP_DIRECTION_PIN 18 // I2C #define I2C_SPEED 10000UL // 10kHz clock speed on I2C bus + #define I2C_SPEED_LOW 1000UL // 10kHz clock speed on I2C bus for external bus #define OBP_I2C_SDA 47 #define OBP_I2C_SCL 21 // DS1388 RTC @@ -22,8 +23,8 @@ #define AS5600_I2C_ADDR 0x36 // Addr. 0x36 (fix) // INA219 #define SHUNT_VOLTAGE 0.075 // Shunt voltage in V by max. current (75mV) - #define INA219_I2C_ADDR1 0x40 // Addr. 0x41 (fix A0 = 5V, A1 = GND) for battery - #define INA219_I2C_ADDR2 0x41 // Addr. 0x44 (fix A0 = GND, A1 = 5V) for solar panels + #define INA219_I2C_ADDR1 0x41 // Addr. 0x41 (fix A0 = 5V, A1 = GND) for battery + #define INA219_I2C_ADDR2 0x44 // Addr. 0x44 (fix A0 = GND, A1 = 5V) for solar panels #define INA219_I2C_ADDR3 0x45 // Addr. 0x45 (fix A0 = 5V, A1 = 5V) for generator // INA226 #define INA226_I2C_ADDR1 0x41 // Addr. 0x41 (fix A0 = 5V, A1 = GND) for battery @@ -82,7 +83,8 @@ // Direction pin for RS485 NMEA0183 #define OBP_DIRECTION_PIN 8 // I2C - #define I2C_SPEED 100000UL // 100kHz clock speed on I2C bus + #define I2C_SPEED 100000UL // 100kHz clock speed on I2C bus + #define I2C_SPEED_LOW 1000UL // 10kHz clock speed on I2C bus for external bus #define OBP_I2C_SDA 21 #define OBP_I2C_SCL 38 // DS1388 RTC @@ -99,8 +101,8 @@ #define AS5600_I2C_ADDR 0x36 // Addr. 0x36 (fix) // INA219 #define SHUNT_VOLTAGE 0.075 // Shunt voltage in V by max. current (75mV) - #define INA219_I2C_ADDR1 0x40 // Addr. 0x41 (fix A0 = 5V, A1 = GND) for battery - #define INA219_I2C_ADDR2 0x41 // Addr. 0x44 (fix A0 = GND, A1 = 5V) for solar panels + #define INA219_I2C_ADDR1 0x41 // Addr. 0x41 (fix A0 = 5V, A1 = GND) for battery + #define INA219_I2C_ADDR2 0x44 // Addr. 0x44 (fix A0 = GND, A1 = 5V) for solar panels #define INA219_I2C_ADDR3 0x45 // Addr. 0x45 (fix A0 = 5V, A1 = 5V) for generator // INA226 #define INA226_I2C_ADDR1 0x41 // Addr. 0x41 (fix A0 = 5V, A1 = GND) for battery diff --git a/lib/obp60task/OBPDataOperations.cpp b/lib/obp60task/OBPDataOperations.cpp index 73908ac..b0774b1 100644 --- a/lib/obp60task/OBPDataOperations.cpp +++ b/lib/obp60task/OBPDataOperations.cpp @@ -1,152 +1,346 @@ +#include "OBP60Formatter.h" #include "OBPDataOperations.h" +//#include "BoatDataCalibration.h" // Functions lib for data instance calibration + +// --- Class CalibrationData --------------- +CalibrationData::CalibrationData(GwLog* log) +{ + logger = log; +} + +void CalibrationData::readConfig(GwConfigHandler* config) +// Initial load of calibration data into internal list +// This method is called once at init phase of to read the configuration values +{ + std::string instance; + double offset; + double slope; + double smooth; + + String calInstance = ""; + String calOffset = ""; + String calSlope = ""; + String calSmooth = ""; + + // Load user format configuration values + String lengthFormat = config->getString(config->lengthFormat); // [m|ft] + String distanceFormat = config->getString(config->distanceFormat); // [m|km|nm] + String speedFormat = config->getString(config->speedFormat); // [m/s|km/h|kn] + String windspeedFormat = config->getString(config->windspeedFormat); // [m/s|km/h|kn|bft] + String tempFormat = config->getString(config->tempFormat); // [K|C|F] + + // Read calibration settings for data instances + for (int i = 0; i < MAX_CALIBRATION_DATA; i++) { + calInstance = "calInstance" + String(i + 1); + calOffset = "calOffset" + String(i + 1); + calSlope = "calSlope" + String(i + 1); + calSmooth = "calSmooth" + String(i + 1); + + instance = std::string(config->getString(calInstance, "---").c_str()); + if (instance == "---") { + LOG_DEBUG(GwLog::LOG, "No calibration data for instance no. %d", i + 1); + continue; + } + + calibrationMap[instance] = { 0.0f, 1.0f, 1.0f, 0.0f, false }; + offset = (config->getString(calOffset, "")).toDouble(); + slope = (config->getString(calSlope, "")).toDouble(); + smooth = (config->getString(calSmooth, "")).toInt(); // user input is int; further math is done with double + + if (slope == 0.0) { + slope = 1.0; // eliminate adjustment if user selected "0" -> that would set the calibrated value to "0" + } + + // Convert calibration values from user input format to internal standard SI format + if (instance == "AWS" || instance == "TWS") { + if (windspeedFormat == "m/s") { + // No conversion needed + } else if (windspeedFormat == "km/h") { + offset /= 3.6; // Convert km/h to m/s + } else if (windspeedFormat == "kn") { + offset /= 1.94384; // Convert kn to m/s + } else if (windspeedFormat == "bft") { + offset *= 2 + (offset / 2); // Convert Bft to m/s (approx) -> to be improved + } + + } else if (instance == "AWA" || instance == "COG" || instance == "HDM" || instance == "HDT" || instance == "PRPOS" || instance == "RPOS" || instance == "TWA" || instance == "TWD") { + offset *= DEG_TO_RAD; // Convert deg to rad + + } else if (instance == "DBS" || instance == "DBT") { + if (lengthFormat == "m") { + // No conversion needed + } else if (lengthFormat == "ft") { + offset /= 3.28084; // Convert ft to m + } + + } else if (instance == "SOG" || instance == "STW") { + if (speedFormat == "m/s") { + // No conversion needed + } else if (speedFormat == "km/h") { + offset /= 3.6; // Convert km/h to m/s + } else if (speedFormat == "kn") { + offset /= 1.94384; // Convert kn to m/s + } + + } else if (instance == "WTemp") { + if (tempFormat == "K" || tempFormat == "C") { + // No conversion needed + } else if (tempFormat == "F") { + offset *= 9.0 / 5.0; // Convert °F to K + slope *= 9.0 / 5.0; // Convert °F to K + } + } + + // transform smoothing factor from [0.01..10] to [0.3..0.95] and invert for exponential smoothing formula + if (smooth <= 0) { + smooth = 0; + } else { + if (smooth > 10) { + smooth = 10; + } + smooth = 0.3 + ((smooth - 0.01) * (0.95 - 0.3) / (10 - 0.01)); + } + smooth = 1 - smooth; + + calibrationMap[instance].offset = offset; + calibrationMap[instance].slope = slope; + calibrationMap[instance].smooth = smooth; + calibrationMap[instance].isCalibrated = false; + LOG_DEBUG(GwLog::LOG, "Calibration data type added: %s, offset: %f, slope: %f, smoothing: %f", instance.c_str(), + calibrationMap[instance].offset, calibrationMap[instance].slope, calibrationMap[instance].smooth); + } + // LOG_DEBUG(GwLog::LOG, "All calibration data read"); +} + +// Handle calibrationMap and calibrate all boat data values +void CalibrationData::handleCalibration(BoatValueList* boatValueList) +{ + GwApi::BoatValue* bValue; + + for (const auto& cMap : calibrationMap) { + std::string instance = cMap.first.c_str(); + bValue = boatValueList->findValueOrCreate(String(instance.c_str())); + + calibrateInstance(bValue); + smoothInstance(bValue); + } +} + +// Calibrate single boat data value +// Return calibrated boat value or DBL_MAX, if no calibration was performed +bool CalibrationData::calibrateInstance(GwApi::BoatValue* boatDataValue) +{ + std::string instance = boatDataValue->getName().c_str(); + double offset = 0; + double slope = 1.0; + double dataValue = 0; + std::string format = ""; + + // we test this earlier, but for safety reasons ... + if (calibrationMap.find(instance) == calibrationMap.end()) { + LOG_DEBUG(GwLog::DEBUG, "BoatDataCalibration: %s not in calibration list", instance.c_str()); + return false; + } + + calibrationMap[instance].isCalibrated = false; // reset calibration flag until properly calibrated + + if (!boatDataValue->valid) { // no valid boat data value, so we don't want to apply calibration data + return false; + } + + offset = calibrationMap[instance].offset; + slope = calibrationMap[instance].slope; + dataValue = boatDataValue->value; + format = boatDataValue->getFormat().c_str(); + // LOG_DEBUG(GwLog::DEBUG, "BoatDataCalibration: %s: value: %f, format: %s", instance.c_str(), dataValue, format.c_str()); + + if (format == "formatWind") { // instance is of type angle + dataValue = (dataValue * slope) + offset; + // dataValue = WindUtils::toPI(dataValue); + dataValue = WindUtils::to2PI(dataValue); // we should call for format of [-180..180], but pages cannot display negative values properly yet + + } else if (format == "formatCourse") { // instance is of type direction + dataValue = (dataValue * slope) + offset; + dataValue = WindUtils::to2PI(dataValue); + + } else if (format == "kelvinToC") { // instance is of type temperature + dataValue = ((dataValue - 273.15) * slope) + offset + 273.15; + + } else { + dataValue = (dataValue * slope) + offset; + } + + + boatDataValue->value = dataValue; // update boat data value with calibrated value + calibrationMap[instance].value = dataValue; // store the calibrated value in the list + calibrationMap[instance].isCalibrated = true; + + // LOG_DEBUG(GwLog::DEBUG, "BoatDataCalibration: %s: Offset: %f, Slope: %f, Result: %f", instance.c_str(), offset, slope, calibrationMap[instance].value); + return true; +} + +// Smooth single boat data value +// Return smoothed boat value or DBL_MAX, if no smoothing was performed +bool CalibrationData::smoothInstance(GwApi::BoatValue* boatDataValue) +{ + std::string instance = boatDataValue->getName().c_str(); + double oldValue = 0; + double dataValue = boatDataValue->value; + double smoothFactor = 0; + + // we test this earlier, but for safety reason ... + if (calibrationMap.find(instance) == calibrationMap.end()) { + // LOG_DEBUG(GwLog::DEBUG, "BoatDataCalibration: %s not in calibration list", instance.c_str()); + return false; + } + + calibrationMap[instance].isCalibrated = false; // reset calibration flag until properly calibrated + + if (!boatDataValue->valid) { // no valid boat data value, so we don't need to do anything + return false; + } + + smoothFactor = calibrationMap[instance].smooth; + + if (lastValue.find(instance) != lastValue.end()) { + oldValue = lastValue[instance]; + dataValue = oldValue + (smoothFactor * (dataValue - oldValue)); // exponential smoothing algorithm + } + lastValue[instance] = dataValue; // store the new value for next cycle; first time, store only the current value and return + + boatDataValue->value = dataValue; // update boat data value with smoothed value + calibrationMap[instance].value = dataValue; // store the smoothed value in the list + calibrationMap[instance].isCalibrated = true; + + // LOG_DEBUG(GwLog::DEBUG, "BoatDataCalibration: %s: smooth: %f, oldValue: %f, result: %f", instance.c_str(), smoothFactor, oldValue, calibrationMap[instance].value); + + return true; +} +// --- End Class CalibrationData --------------- // --- Class HstryBuf --------------- -// Init history buffers for selected boat data -void HstryBuf::init(BoatValueList* boatValues, GwLog *log) { +HstryBuf::HstryBuf(const String& name, int size, BoatValueList* boatValues, GwLog* log) + : logger(log) + , boatDataName(name) +{ + hstryBuf.resize(size); + boatValue = boatValues->findValueOrCreate(name); +} - logger = log; - - int hstryUpdFreq = 1000; // Update frequency for history buffers in ms - int hstryMinVal = 0; // Minimum value for these history buffers - twdHstryMax = 6283; // Max value for wind direction (TWD, AWD) in rad [0...2*PI], shifted by 1000 for 3 decimals - twsHstryMax = 65000; // Max value for wind speed (TWS, AWS) in m/s [0..65], shifted by 1000 for 3 decimals - awdHstryMax = twdHstryMax; - awsHstryMax = twsHstryMax; - twdHstryMin = hstryMinVal; - twsHstryMin = hstryMinVal; - awdHstryMin = hstryMinVal; - awsHstryMin = hstryMinVal; - const double DBL_MAX = std::numeric_limits::max(); - - // Initialize history buffers with meta data - hstryBufList.twdHstry->setMetaData("TWD", "formatCourse", hstryUpdFreq, hstryMinVal, twdHstryMax); - hstryBufList.twsHstry->setMetaData("TWS", "formatKnots", hstryUpdFreq, hstryMinVal, twsHstryMax); - hstryBufList.awdHstry->setMetaData("AWD", "formatCourse", hstryUpdFreq, hstryMinVal, twdHstryMax); - hstryBufList.awsHstry->setMetaData("AWS", "formatKnots", hstryUpdFreq, hstryMinVal, twsHstryMax); - - // create boat values for history data types, if they don't exist yet - twdBVal = boatValues->findValueOrCreate(hstryBufList.twdHstry->getName()); - twsBVal = boatValues->findValueOrCreate(hstryBufList.twsHstry->getName()); - twaBVal = boatValues->findValueOrCreate("TWA"); - awdBVal = boatValues->findValueOrCreate(hstryBufList.awdHstry->getName()); - awsBVal = boatValues->findValueOrCreate(hstryBufList.awsHstry->getName()); - - if (!awdBVal->valid) { // AWD usually does not exist - awdBVal->setFormat(hstryBufList.awdHstry->getFormat()); - awdBVal->value = DBL_MAX; +void HstryBuf::init(const String& format, int updFreq, int mltplr, double minVal, double maxVal) +{ + hstryBuf.setMetaData(boatDataName, format, updFreq, mltplr, minVal, maxVal); + hstryMin = minVal; + hstryMax = maxVal; + if (!boatValue->valid) { + boatValue->setFormat(format); + boatValue->value = std::numeric_limits::max(); // mark current value invalid } +} + +void HstryBuf::add(double value) +{ + if (value >= hstryMin && value <= hstryMax) { + hstryBuf.add(value); + // LOG_DEBUG(GwLog::DEBUG, "HstryBuf::add: name: %s, value: %.3f", hstryBuf.getName(), value); + } +} + +void HstryBuf::handle(bool useSimuData, CommonData& common) +{ + // GwApi::BoatValue* tmpBVal; + std::unique_ptr tmpBVal; // Temp variable to get formatted and converted data value from OBP60Formatter + + // create temporary boat value for calibration purposes and retrieval of simulation value + // tmpBVal = new GwApi::BoatValue(boatDataName.c_str()); + tmpBVal = std::unique_ptr(new GwApi::BoatValue(boatDataName)); + tmpBVal->setFormat(boatValue->getFormat()); + tmpBVal->value = boatValue->value; + tmpBVal->valid = boatValue->valid; + + if (boatValue->valid) { + // Calibrate boat value before adding it to history buffer + //calibrationData.calibrateInstance(tmpBVal.get(), logger); + //add(tmpBVal->value); + add(boatValue->value); + + } else if (useSimuData) { // add simulated value to history buffer + double simSIValue = common.fmt->formatValue(tmpBVal.get(), common).value; // simulated value is generated at ; here: retreive SI value + add(simSIValue); + } else { + // here we will add invalid (DBL_MAX) value; this will mark periods of missing data in buffer together with a timestamp + } +} +// --- End Class HstryBuf --------------- + +// --- Class HstryBuffers --------------- +HstryBuffers::HstryBuffers(int size, BoatValueList* boatValues, GwLog* log) + : size(size) + , boatValueList(boatValues) + , logger(log) +{ // collect boat values for true wind calculation - awaBVal = boatValues->findValueOrCreate("AWA"); - hdtBVal = boatValues->findValueOrCreate("HDT"); - hdmBVal = boatValues->findValueOrCreate("HDM"); - varBVal = boatValues->findValueOrCreate("VAR"); - cogBVal = boatValues->findValueOrCreate("COG"); - sogBVal = boatValues->findValueOrCreate("SOG"); + // should all have been already created at true wind object initialization + // potentially to be moved to history buffer handling + awaBVal = boatValueList->findValueOrCreate("AWA"); + hdtBVal = boatValueList->findValueOrCreate("HDT"); + hdmBVal = boatValueList->findValueOrCreate("HDM"); + varBVal = boatValueList->findValueOrCreate("VAR"); + cogBVal = boatValueList->findValueOrCreate("COG"); + sogBVal = boatValueList->findValueOrCreate("SOG"); + awdBVal = boatValueList->findValueOrCreate("AWD"); } -// Handle history buffers for TWD, TWS, AWD, AWS -//void HstryBuf::handleHstryBuf(GwApi* api, BoatValueList* boatValues, bool useSimuData) { -void HstryBuf::handleHstryBuf(bool useSimuData) { - - static int16_t twd = 20; //initial value only relevant if we use simulation data - static uint16_t tws = 20; //initial value only relevant if we use simulation data - static double awd, aws, hdt = 20; //initial value only relevant if we use simulation data - GwApi::BoatValue *calBVal; // temp variable just for data calibration -> we don't want to calibrate the original data here - - LOG_DEBUG(GwLog::DEBUG,"obp60task handleHstryBuf: TWD_isValid? %d, twdBVal: %.1f, twaBVal: %.1f, twsBVal: %.1f", twdBVal->valid, twdBVal->value * RAD_TO_DEG, - twaBVal->value * RAD_TO_DEG, twsBVal->value * 3.6 / 1.852); - - if (twdBVal->valid) { - calBVal = new GwApi::BoatValue("TWD"); // temporary solution for calibration of history buffer values - calBVal->setFormat(twdBVal->getFormat()); - calBVal->value = twdBVal->value; - calBVal->valid = twdBVal->valid; - calibrationData.calibrateInstance(calBVal, logger); // Check if boat data value is to be calibrated - twd = static_cast(std::round(calBVal->value * 1000.0)); - if (twd >= twdHstryMin && twd <= twdHstryMax) { - hstryBufList.twdHstry->add(twd); - } - delete calBVal; - calBVal = nullptr; - } else if (useSimuData) { - twd += random(-20, 20); - twd = WindUtils::to360(twd); - hstryBufList.twdHstry->add(static_cast(DegToRad(twd) * 1000.0)); +// Create history buffer for boat data type +void HstryBuffers::addBuffer(const String& name) +{ + if (HstryBuffers::getBuffer(name) != nullptr) { // buffer for this data type already exists + return; + } + if (bufferParams.find(name) == bufferParams.end()) { // requested boat data type is not supported in list of + return; } - if (twsBVal->valid) { - calBVal = new GwApi::BoatValue("TWS"); // temporary solution for calibration of history buffer values - calBVal->setFormat(twsBVal->getFormat()); - calBVal->value = twsBVal->value; - calBVal->valid = twsBVal->valid; - calibrationData.calibrateInstance(calBVal, logger); // Check if boat data value is to be calibrated - tws = static_cast(std::round(calBVal->value * 1000)); - if (tws >= twsHstryMin && tws <= twsHstryMax) { - hstryBufList.twsHstry->add(tws); - } - delete calBVal; - calBVal = nullptr; - } else if (useSimuData) { - tws += random(-5000, 5000); // TWS value in m/s; expands to 3 decimals - tws = constrain(tws, 0, 25000); // Limit TWS to [0..25] m/s - hstryBufList.twsHstry->add(tws); - } + hstryBuffers[name] = std::unique_ptr(new HstryBuf(name, size, boatValueList, logger)); - if (awaBVal->valid) { - if (hdtBVal->valid) { - hdt = hdtBVal->value; // Use HDT if available - } else { - hdt = WindUtils::calcHDT(&hdmBVal->value, &varBVal->value, &cogBVal->value, &sogBVal->value); - } + // Initialize metadata for buffer + String valueFormat = bufferParams[name].format; // Data format of boat data type + // String valueFormat = boatValueList->findValueOrCreate(name)->getFormat().c_str(); // Unfortunately, format is not yet available during system initialization + int hstryUpdFreq = bufferParams[name].hstryUpdFreq; // Update frequency for history buffers in ms + int mltplr = bufferParams[name].mltplr; // default multiplier which transforms original value into buffer type format + double bufferMinVal = bufferParams[name].bufferMinVal; // Min value for this history buffer + double bufferMaxVal = bufferParams[name].bufferMaxVal; // Max value for this history buffer - awd = awaBVal->value + hdt; - awd = WindUtils::to2PI(awd); - calBVal = new GwApi::BoatValue("AWD"); // temporary solution for calibration of history buffer values - calBVal->value = awd; - calBVal->setFormat(awdBVal->getFormat()); - calBVal->valid = true; - calibrationData.calibrateInstance(calBVal, logger); // Check if boat data value is to be calibrated - awdBVal->value = calBVal->value; - awdBVal->valid = true; - awd = std::round(calBVal->value * 1000.0); - if (awd >= awdHstryMin && awd <= awdHstryMax) { - hstryBufList.awdHstry->add(static_cast(awd)); - } - delete calBVal; - calBVal = nullptr; - } else if (useSimuData) { - awd += random(-20, 20); - awd = WindUtils::to360(awd); - hstryBufList.awdHstry->add(static_cast(DegToRad(awd) * 1000.0)); - } - - if (awsBVal->valid) { - calBVal = new GwApi::BoatValue("AWS"); // temporary solution for calibration of history buffer values - calBVal->setFormat(awsBVal->getFormat()); - calBVal->value = awsBVal->value; - calBVal->valid = awsBVal->valid; - calibrationData.calibrateInstance(calBVal, logger); // Check if boat data value is to be calibrated - aws = std::round(calBVal->value * 1000); - if (aws >= awsHstryMin && aws <= awsHstryMax) { - hstryBufList.awsHstry->add(static_cast(aws)); - } - delete calBVal; - calBVal = nullptr; - } else if (useSimuData) { - aws += random(-5000, 5000); // TWS value in m/s; expands to 1 decimal - aws = constrain(aws, 0, 25000); // Limit TWS to [0..25] m/s - hstryBufList.awsHstry->add(aws); + hstryBuffers[name]->init(valueFormat, hstryUpdFreq, mltplr, bufferMinVal, bufferMaxVal); + LOG_DEBUG(GwLog::DEBUG, "HstryBuffers: new buffer added: name: %s, format: %s, multiplier: %d, min value: %.2f, max value: %.2f", name, valueFormat, mltplr, bufferMinVal, bufferMaxVal); +} + +// Handle all registered history buffers +void HstryBuffers::handleHstryBufs(bool useSimuData, CommonData& common) +{ + for (auto& bufMap : hstryBuffers) { + auto& buf = bufMap.second; + buf->handle(useSimuData, common); } } -// --- Class HstryBuf --------------- + +RingBuffer* HstryBuffers::getBuffer(const String& name) +{ + auto it = hstryBuffers.find(name); + if (it != hstryBuffers.end()) { + return &it->second->hstryBuf; + } + return nullptr; +} +// --- End Class HstryBuffers --------------- // --- Class WindUtils -------------- double WindUtils::to2PI(double a) { - a = fmod(a, 2 * M_PI); + a = fmod(a, M_TWOPI); if (a < 0.0) { - a += 2 * M_PI; + a += M_TWOPI; } return a; } @@ -162,18 +356,18 @@ double WindUtils::toPI(double a) double WindUtils::to360(double a) { - a = fmod(a, 360); + a = fmod(a, 360.0); if (a < 0.0) { - a += 360; + a += 360.0; } return a; } double WindUtils::to180(double a) { - a += 180; + a += 180.0; a = to360(a); - a -= 180; + a -= 180.0; return a; } @@ -205,14 +399,14 @@ void WindUtils::addPolar(const double* phi1, const double* r1, void WindUtils::calcTwdSA(const double* AWA, const double* AWS, const double* CTW, const double* STW, const double* HDT, - double* TWD, double* TWS, double* TWA) + double* TWD, double* TWS, double* TWA, double* AWD) { - double awd = *AWA + *HDT; - awd = to2PI(awd); + *AWD = *AWA + *HDT; + *AWD = to2PI(*AWD); double stw = -*STW; - addPolar(&awd, AWS, CTW, &stw, TWD, TWS); + addPolar(AWD, AWS, CTW, &stw, TWD, TWS); - // Normalize TWD and TWA to 0-360° + // Normalize TWD to [0..360°] (2PI) and TWA to [-180..180] (PI) *TWD = to2PI(*TWD); *TWA = toPI(*TWD - *HDT); } @@ -234,12 +428,12 @@ double WindUtils::calcHDT(const double* hdmVal, const double* varVal, const doub return hdt; } -bool WindUtils::calcTrueWind(const double* awaVal, const double* awsVal, +bool WindUtils::calcWinds(const double* awaVal, const double* awsVal, const double* cogVal, const double* stwVal, const double* sogVal, const double* hdtVal, - const double* hdmVal, const double* varVal, double* twdVal, double* twsVal, double* twaVal) + const double* hdmVal, const double* varVal, double* twdVal, double* twsVal, double* twaVal, double* awdVal) { double stw, hdt, ctw; - double twd, tws, twa; + double twd, tws, twa, awd; double minSogVal = 0.1; // SOG below this value (m/s) is assumed to be data noise from GPS sensor if (*hdtVal != DBL_MAX) { @@ -263,60 +457,81 @@ bool WindUtils::calcTrueWind(const double* awaVal, const double* awsVal, // If STW and SOG are not available, we cannot calculate true wind return false; } - // Serial.println("\ncalcTrueWind: HDT: " + String(hdt) + ", CTW: " + String(ctw) + ", STW: " + String(stw)); + // LOG_DEBUG(GwLog::DEBUG, "WindUtils:calcWinds: HDT: %.1f, CTW %.1f, STW %.1f", hdt, ctw, stw); if ((*awaVal == DBL_MAX) || (*awsVal == DBL_MAX)) { // Cannot calculate true wind without valid AWA, AWS; other checks are done earlier return false; } else { - calcTwdSA(awaVal, awsVal, &ctw, &stw, &hdt, &twd, &tws, &twa); + calcTwdSA(awaVal, awsVal, &ctw, &stw, &hdt, &twd, &tws, &twa, &awd); *twdVal = twd; *twsVal = tws; *twaVal = twa; + *awdVal = awd; return true; } } // Calculate true wind data and add to obp60task boat data list -bool WindUtils::addTrueWind(GwApi* api, BoatValueList* boatValues, GwLog* log) { +bool WindUtils::addWinds() +{ + double twd, tws, twa, awd, hdt; + bool twCalculated = false; + bool awdCalculated = false; - GwLog* logger = log; + double awaVal = awaBVal->valid ? awaBVal->value : DBL_MAX; + double awsVal = awsBVal->valid ? awsBVal->value : DBL_MAX; + double cogVal = cogBVal->valid ? cogBVal->value : DBL_MAX; + double stwVal = stwBVal->valid ? stwBVal->value : DBL_MAX; + double sogVal = sogBVal->valid ? sogBVal->value : DBL_MAX; + double hdtVal = hdtBVal->valid ? hdtBVal->value : DBL_MAX; + double hdmVal = hdmBVal->valid ? hdmBVal->value : DBL_MAX; + double varVal = varBVal->valid ? varBVal->value : DBL_MAX; + //LOG_DEBUG(GwLog::DEBUG, "WindUtils:addWinds: AWA %.1f, AWS %.1f, COG %.1f, STW %.1f, SOG %.2f, HDT %.1f, HDM %.1f, VAR %.1f", awaBVal->value * RAD_TO_DEG, awsBVal->value * 3.6 / 1.852, + // cogBVal->value * RAD_TO_DEG, stwBVal->value * 3.6 / 1.852, sogBVal->value * 3.6 / 1.852, hdtBVal->value * RAD_TO_DEG, hdmBVal->value * RAD_TO_DEG, varBVal->value * RAD_TO_DEG); - double awaVal, awsVal, cogVal, stwVal, sogVal, hdtVal, hdmVal, varVal; - double twd, tws, twa; - bool isCalculated = false; - - awaVal = awaBVal->valid ? awaBVal->value : DBL_MAX; - awsVal = awsBVal->valid ? awsBVal->value : DBL_MAX; - cogVal = cogBVal->valid ? cogBVal->value : DBL_MAX; - stwVal = stwBVal->valid ? stwBVal->value : DBL_MAX; - sogVal = sogBVal->valid ? sogBVal->value : DBL_MAX; - hdtVal = hdtBVal->valid ? hdtBVal->value : DBL_MAX; - hdmVal = hdmBVal->valid ? hdmBVal->value : DBL_MAX; - varVal = varBVal->valid ? varBVal->value : DBL_MAX; - LOG_DEBUG(GwLog::DEBUG,"obp60task addTrueWind: AWA %.1f, AWS %.1f, COG %.1f, STW %.1f, SOG %.2f, HDT %.1f, HDM %.1f, VAR %.1f", awaBVal->value * RAD_TO_DEG, awsBVal->value * 3.6 / 1.852, - cogBVal->value * RAD_TO_DEG, stwBVal->value * 3.6 / 1.852, sogBVal->value * 3.6 / 1.852, hdtBVal->value * RAD_TO_DEG, hdmBVal->value * RAD_TO_DEG, varBVal->value * RAD_TO_DEG); - - isCalculated = calcTrueWind(&awaVal, &awsVal, &cogVal, &stwVal, &sogVal, &hdtVal, &hdmVal, &varVal, &twd, &tws, &twa); - - if (isCalculated) { // Replace values only, if successfully calculated and not already available + // Check if TWD can be calculated from TWA and HDT/HDM + if (twaBVal->valid) { if (!twdBVal->valid) { + if (hdtVal != DBL_MAX) { + hdt = hdtVal; // Use HDT if available + } else { + hdt = calcHDT(&hdmVal, &varVal, &cogVal, &sogVal); + } + twd = twaBVal->value + hdt; + twd = to2PI(twd); twdBVal->value = twd; twdBVal->valid = true; } - if (!twsBVal->valid) { - twsBVal->value = tws; - twsBVal->valid = true; - } - if (!twaBVal->valid) { - twaBVal->value = twa; - twaBVal->valid = true; + + } else { + // Calculate true winds and AWD; if true winds exist, use at least AWD calculation + twCalculated = calcWinds(&awaVal, &awsVal, &cogVal, &stwVal, &sogVal, &hdtVal, &hdmVal, &varVal, &twd, &tws, &twa, &awd); + + if (twCalculated) { // Replace values only, if successfully calculated and not already available + if (!twdBVal->valid) { + twdBVal->value = twd; + twdBVal->valid = true; + } + if (!twsBVal->valid) { + twsBVal->value = tws; + twsBVal->valid = true; + } + if (!twaBVal->valid) { + //twaBVal->value = twa; + twaBVal->value = to2PI(twa); // convert to [0..360], because pages cannot display negative values properly yet + twaBVal->valid = true; + } + if (!awdBVal->valid) { + awdBVal->value = awd; + awdBVal->valid = true; + } } } - LOG_DEBUG(GwLog::DEBUG,"obp60task addTrueWind: isCalculated %d, TWD %.1f, TWA %.1f, TWS %.1f", isCalculated, twdBVal->value * RAD_TO_DEG, - twaBVal->value * RAD_TO_DEG, twsBVal->value * 3.6 / 1.852); + // LOG_DEBUG(GwLog::DEBUG, "WindUtils:addWinds: twCalculated %d, TWD %.1f, TWA %.1f, TWS %.2f kn, AWD: %.1f", twCalculated, twdBVal->value * RAD_TO_DEG, + // twaBVal->value * RAD_TO_DEG, twsBVal->value * 3.6 / 1.852, awdBVal->value * RAD_TO_DEG); - return isCalculated; + return twCalculated; } -// --- Class WindUtils -------------- +// --- End Class WindUtils -------------- diff --git a/lib/obp60task/OBPDataOperations.h b/lib/obp60task/OBPDataOperations.h index c93c1fe..9c5b783 100644 --- a/lib/obp60task/OBPDataOperations.h +++ b/lib/obp60task/OBPDataOperations.h @@ -1,68 +1,116 @@ +// Function lib for boat data calibration, history buffer handling, true wind calculation, and other operations on boat data #pragma once -#include #include "OBPRingBuffer.h" -#include "BoatDataCalibration.h" // Functions lib for data instance calibration +#include "Pagedata.h" #include "obp60task.h" -#include +#include +#include -typedef struct { - RingBuffer* twdHstry; - RingBuffer* twsHstry; - RingBuffer* awdHstry; - RingBuffer* awsHstry; -} tBoatHstryData; // Holds pointers to all history buffers for boat data +// Calibration of boat data values, when user setting available +// supported boat data types are: AWA, AWS, COG, DBS, DBT, HDM, HDT, PRPOS, RPOS, SOG, STW, TWA, TWS, TWD, WTemp +class CalibrationData { +private: + typedef struct { + double offset; // calibration offset + double slope; // calibration slope + double smooth; // smoothing factor + double value; // calibrated data value (for future use) + bool isCalibrated; // is data instance value calibrated? (for future use) + } tCalibrationData; + + std::unordered_map calibrationMap; // list of calibration data instances + std::unordered_map lastValue; // array for last smoothed values of boat data values + GwLog* logger; + + static constexpr int8_t MAX_CALIBRATION_DATA = 4; // maximum number of calibration data instances + +public: + CalibrationData(GwLog* log); + void readConfig(GwConfigHandler* config); + void handleCalibration(BoatValueList* boatValues); // Handle calibrationMap and calibrate all boat data values + bool calibrateInstance(GwApi::BoatValue* boatDataValue); // Calibrate single boat data value + bool smoothInstance(GwApi::BoatValue* boatDataValue); // Smooth single boat data value +}; class HstryBuf { private: - GwLog *logger; + RingBuffer hstryBuf; // Circular buffer to store history values + String boatDataName; + double hstryMin; + double hstryMax; + GwApi::BoatValue* boatValue; + GwLog* logger; - RingBuffer twdHstry; // Circular buffer to store true wind direction values - RingBuffer twsHstry; // Circular buffer to store true wind speed values (TWS) - RingBuffer awdHstry; // Circular buffer to store apparant wind direction values - RingBuffer awsHstry; // Circular buffer to store apparant xwind speed values (AWS) - int16_t twdHstryMin; // Min value for wind direction (TWD) in history buffer - int16_t twdHstryMax; // Max value for wind direction (TWD) in history buffer - uint16_t twsHstryMin; - uint16_t twsHstryMax; - int16_t awdHstryMin; - int16_t awdHstryMax; - uint16_t awsHstryMin; - uint16_t awsHstryMax; - - // boat values for buffers and for true wind calculation - GwApi::BoatValue *twdBVal, *twsBVal, *twaBVal, *awdBVal, *awsBVal; - GwApi::BoatValue *awaBVal, *hdtBVal, *hdmBVal, *varBVal, *cogBVal, *sogBVal; + friend class HstryBuffers; public: - tBoatHstryData hstryBufList; + HstryBuf(const String& name, int size, BoatValueList* boatValues, GwLog* log); + void init(const String& format, int updFreq, int mltplr, double minVal, double maxVal); + void add(double value); + void handle(bool useSimuData, CommonData& common); +}; - HstryBuf(){ - hstryBufList = {&twdHstry, &twsHstry, &awdHstry, &awsHstry}; // Generate history buffers of zero size +class HstryBuffers { +private: + std::map> hstryBuffers; + int size; // size of all history buffers + BoatValueList* boatValueList; + GwLog* logger; + GwApi::BoatValue *awaBVal, *hdtBVal, *hdmBVal, *varBVal, *cogBVal, *sogBVal, *awdBVal; // boat values for true wind calculation + + struct HistoryParams { + int hstryUpdFreq; // update frequency of history buffer (documentation only) + int mltplr; // specifies actual value precision being storable: + // [10000: 0 - 6.5535 | 1000: 0 - 65.535 | 100: 0 - 650.35 | 10: 0 - 6503.5 + double bufferMinVal; // minimum valid data value + double bufferMaxVal; // maximum valid data value + String format; // format of data type }; - HstryBuf(int size) { - hstryBufList = {&twdHstry, &twsHstry, &awdHstry, &awsHstry}; - hstryBufList.twdHstry->resize(960); // store 960 TWD values for 16 minutes history - hstryBufList.twsHstry->resize(960); - hstryBufList.awdHstry->resize(960); - hstryBufList.awsHstry->resize(960); + + // Define buffer parameters for supported boat data type + std::map bufferParams = { + { "AWA", { 1000, 10000, 0.0, M_TWOPI, "formatWind" } }, + { "AWD", { 1000, 10000, 0.0, M_TWOPI, "formatCourse" } }, + { "AWS", { 1000, 1000, 0.0, 65.0, "formatKnots" } }, + { "COG", { 1000, 10000, 0.0, M_TWOPI, "formatCourse" } }, + { "DBS", { 1000, 100, 0.0, 650.0, "formatDepth" } }, + { "DBT", { 1000, 100, 0.0, 650.0, "formatDepth" } }, + { "DPT", { 1000, 100, 0.0, 650.0, "formatDepth" } }, + { "HDM", { 1000, 10000, 0.0, M_TWOPI, "formatCourse" } }, + { "HDT", { 1000, 10000, 0.0, M_TWOPI, "formatCourse" } }, + { "ROT", { 1000, 10000, -M_PI / 180.0 * 99.0, M_PI / 180.0 * 99.0, "formatRot" } }, // min/max is -/+ 99 degrees for "rate of turn" + { "SOG", { 1000, 1000, 0.0, 65.0, "formatKnots" } }, + { "STW", { 1000, 1000, 0.0, 65.0, "formatKnots" } }, + { "TWA", { 1000, 10000, 0.0, M_TWOPI, "formatWind" } }, + { "TWD", { 1000, 10000, 0.0, M_TWOPI, "formatCourse" } }, + { "TWS", { 1000, 1000, 0.0, 65.0, "formatKnots" } }, + { "WTemp", { 1000, 100, 233.0, 650.0, "kelvinToC" } } // [-50..376] °C }; - void init(BoatValueList* boatValues, GwLog *log); - void handleHstryBuf(bool useSimuData); + +public: + HstryBuffers(int size, BoatValueList* boatValues, GwLog* log); + void addBuffer(const String& name); + void handleHstryBufs(bool useSimuData, CommonData& common); + RingBuffer* getBuffer(const String& name); }; class WindUtils { private: - GwApi::BoatValue *twdBVal, *twsBVal, *twaBVal; - GwApi::BoatValue *awaBVal, *awsBVal, *cogBVal, *stwBVal, *sogBVal, *hdtBVal, *hdmBVal, *varBVal; + GwApi::BoatValue *twaBVal, *twsBVal, *twdBVal; + GwApi::BoatValue *awaBVal, *awsBVal, *awdBVal, *cogBVal, *stwBVal, *sogBVal, *hdtBVal, *hdmBVal, *varBVal; static constexpr double DBL_MAX = std::numeric_limits::max(); + GwLog* logger; public: - WindUtils(BoatValueList* boatValues){ - twdBVal = boatValues->findValueOrCreate("TWD"); - twsBVal = boatValues->findValueOrCreate("TWS"); + WindUtils(BoatValueList* boatValues, GwLog* log) + : logger(log) + { twaBVal = boatValues->findValueOrCreate("TWA"); + twsBVal = boatValues->findValueOrCreate("TWS"); + twdBVal = boatValues->findValueOrCreate("TWD"); awaBVal = boatValues->findValueOrCreate("AWA"); awsBVal = boatValues->findValueOrCreate("AWS"); + awdBVal = boatValues->findValueOrCreate("AWD"); cogBVal = boatValues->findValueOrCreate("COG"); stwBVal = boatValues->findValueOrCreate("STW"); sogBVal = boatValues->findValueOrCreate("SOG"); @@ -70,6 +118,7 @@ public: hdmBVal = boatValues->findValueOrCreate("HDM"); varBVal = boatValues->findValueOrCreate("VAR"); }; + static double to2PI(double a); static double toPI(double a); static double to360(double a); @@ -81,10 +130,10 @@ public: double* phi, double* r); void calcTwdSA(const double* AWA, const double* AWS, const double* CTW, const double* STW, const double* HDT, - double* TWD, double* TWS, double* TWA); + double* TWD, double* TWS, double* TWA, double* AWD); static double calcHDT(const double* hdmVal, const double* varVal, const double* cogVal, const double* sogVal); - bool calcTrueWind(const double* awaVal, const double* awsVal, + bool calcWinds(const double* awaVal, const double* awsVal, const double* cogVal, const double* stwVal, const double* sogVal, const double* hdtVal, - const double* hdmVal, const double* varVal, double* twdVal, double* twsVal, double* twaVal); - bool addTrueWind(GwApi* api, BoatValueList* boatValues, GwLog *log); + const double* hdmVal, const double* varVal, double* twdVal, double* twsVal, double* twaVal, double* awdVal); + bool addWinds(); }; \ No newline at end of file diff --git a/lib/obp60task/OBPRingBuffer.h b/lib/obp60task/OBPRingBuffer.h index 62e701e..970245e 100644 --- a/lib/obp60task/OBPRingBuffer.h +++ b/lib/obp60task/OBPRingBuffer.h @@ -1,15 +1,44 @@ #pragma once +#include "FreeRTOS.h" #include "GwSynchronized.h" -#include -#include -#include #include -#include "WString.h" +#include + +template +struct PSRAMAllocator { + using value_type = T; + + PSRAMAllocator() = default; + + template + constexpr PSRAMAllocator(const PSRAMAllocator&) noexcept { } + + T* allocate(std::size_t n) + { + void* ptr = heap_caps_malloc(n * sizeof(T), MALLOC_CAP_SPIRAM); + if (!ptr) { + return nullptr; + } else { + return static_cast(ptr); + } + } + + void deallocate(T* p, std::size_t) noexcept + { + heap_caps_free(p); + } +}; + +template +bool operator==(const PSRAMAllocator&, const PSRAMAllocator&) { return true; } + +template +bool operator!=(const PSRAMAllocator&, const PSRAMAllocator&) { return false; } template class RingBuffer { private: - std::vector buffer; // THE buffer vector + std::vector> buffer; // THE buffer vector, allocated in PSRAM size_t capacity; size_t head; // Points to the next insertion position size_t first; // Points to the first (oldest) valid element @@ -18,49 +47,52 @@ private: bool is_Full; // Indicates that all buffer elements are used and ringing is in use T MIN_VAL; // lowest possible value of buffer of type T MAX_VAL; // highest possible value of buffer of type -> indicates invalid value in buffer + double dblMIN_VAL, dblMAX_VAL; // MIN_VAL, MAX_VAL in double format mutable SemaphoreHandle_t bufLocker; // metadata for buffer String dataName; // Name of boat data in buffer String dataFmt; // Format of boat data in buffer int updFreq; // Update frequency in milliseconds - T smallest; // Value range of buffer: smallest value; needs to be => MIN_VAL - T largest; // Value range of buffer: biggest value; needs to be < MAX_VAL, since MAX_VAL indicates invalid entries + double mltplr; // Multiplier which transforms original value into buffer type format + double smallest; // Value range of buffer: smallest value; needs to be => MIN_VAL + double largest; // Value range of buffer: biggest value; needs to be < MAX_VAL, since MAX_VAL indicates invalid entries void initCommon(); public: RingBuffer(); RingBuffer(size_t size); - void setMetaData(String name, String format, int updateFrequency, T minValue, T maxValue); // Set meta data for buffer - bool getMetaData(String& name, String& format, int& updateFrequency, T& minValue, T& maxValue); // Get meta data of buffer + void setMetaData(String name, String format, int updateFrequency, double multiplier, double minValue, double maxValue); // Set meta data for buffer + bool getMetaData(String& name, String& format, int& updateFrequency, double& multiplier, double& minValue, double& maxValue); // Get meta data of buffer bool getMetaData(String& name, String& format); String getName() const; // Get buffer name String getFormat() const; // Get buffer data format - void add(const T& value); // Add a new value to buffer - T get(size_t index) const; // Get value at specific position (0-based index from oldest to newest) - T getFirst() const; // Get the first (oldest) value in buffer - T getLast() const; // Get the last (newest) value in buffer - T getMin() const; // Get the lowest value in buffer - T getMin(size_t amount) const; // Get minimum value of the last values of buffer - T getMax() const; // Get the highest value in buffer - T getMax(size_t amount) const; // Get maximum value of the last values of buffer - T getMid() const; // Get mid value between and value in buffer - T getMid(size_t amount) const; // Get mid value between and value of the last values of buffer - T getMedian() const; // Get the median value in buffer - T getMedian(size_t amount) const; // Get the median value of the last values of buffer + void add(const double& value); // Add a new value to buffer + double get(size_t index) const; // Get value at specific position (0-based index from oldest to newest) + double getFirst() const; // Get the first (oldest) value in buffer + double getLast() const; // Get the last (newest) value in buffer + double getMin() const; // Get the lowest value in buffer + double getMin(size_t amount) const; // Get minimum value of the last values of buffer + double getMax() const; // Get the highest value in buffer + double getMax(size_t amount) const; // Get maximum value of the last values of buffer + double getMid() const; // Get mid value between and value in buffer + double getMid(size_t amount) const; // Get mid value between and value of the last values of buffer + double getMedian() const; // Get the median value in buffer + double getMedian(size_t amount) const; // Get the median value of the last values of buffer size_t getCapacity() const; // Get the buffer capacity (maximum size) size_t getCurrentSize() const; // Get the current number of elements in buffer size_t getFirstIdx() const; // Get the index of oldest value in buffer size_t getLastIdx() const; // Get the index of newest value in buffer bool isEmpty() const; // Check if buffer is empty bool isFull() const; // Check if buffer is full - T getMinVal() const; // Get lowest possible value for buffer - T getMaxVal() const; // Get highest possible value for buffer; used for unset/invalid buffer data + double getMinVal() const; // Get lowest possible value for buffer + double getMaxVal() const; // Get highest possible value for buffer; used for unset/invalid buffer data void clear(); // Clear buffer void resize(size_t size); // Delete buffer and set new size - T operator[](size_t index) const; // Operator[] for convenient access (same as get()) - std::vector getAllValues() const; // Get all current values as a vector + double operator[](size_t index) const; // Operator[] for convenient access (same as get()) + std::vector getAllValues() const; // Get all current values in native buffer format as a vector + std::vector getAllValues(size_t amount) const; // Get last values in native buffer format as a vector }; #include "OBPRingBuffer.tpp" \ No newline at end of file diff --git a/lib/obp60task/OBPRingBuffer.tpp b/lib/obp60task/OBPRingBuffer.tpp index e6951c5..7d73f46 100644 --- a/lib/obp60task/OBPRingBuffer.tpp +++ b/lib/obp60task/OBPRingBuffer.tpp @@ -1,14 +1,21 @@ #include "OBPRingBuffer.h" +#include +#include +#include template -void RingBuffer::initCommon() { +void RingBuffer::initCommon() +{ MIN_VAL = std::numeric_limits::lowest(); MAX_VAL = std::numeric_limits::max(); + dblMIN_VAL = static_cast(MIN_VAL); + dblMAX_VAL = static_cast(MAX_VAL); dataName = ""; dataFmt = ""; updFreq = -1; - smallest = MIN_VAL; - largest = MAX_VAL; + mltplr = 1; + smallest = dblMIN_VAL; + largest = dblMAX_VAL; bufLocker = xSemaphoreCreateMutex(); } @@ -35,24 +42,27 @@ RingBuffer::RingBuffer(size_t size) , is_Full(false) { initCommon(); + + buffer.reserve(size); buffer.resize(size, MAX_VAL); // MAX_VAL indicate invalid values } // Specify meta data of buffer content template -void RingBuffer::setMetaData(String name, String format, int updateFrequency, T minValue, T maxValue) +void RingBuffer::setMetaData(String name, String format, int updateFrequency, double multiplier, double minValue, double maxValue) { GWSYNCHRONIZED(&bufLocker); dataName = name; dataFmt = format; updFreq = updateFrequency; - smallest = std::max(MIN_VAL, minValue); - largest = std::min(MAX_VAL, maxValue); + mltplr = multiplier; + smallest = std::max(dblMIN_VAL, minValue); + largest = std::min(dblMAX_VAL, maxValue); } // Get meta data of buffer content template -bool RingBuffer::getMetaData(String& name, String& format, int& updateFrequency, T& minValue, T& maxValue) +bool RingBuffer::getMetaData(String& name, String& format, int& updateFrequency, double& multiplier, double& minValue, double& maxValue) { if (dataName == "" || dataFmt == "" || updFreq == -1) { return false; // Meta data not set @@ -62,6 +72,7 @@ bool RingBuffer::getMetaData(String& name, String& format, int& updateFrequen name = dataName; format = dataFmt; updateFrequency = updFreq; + multiplier = mltplr; minValue = smallest; maxValue = largest; return true; @@ -97,13 +108,13 @@ String RingBuffer::getFormat() const // Add a new value to buffer template -void RingBuffer::add(const T& value) +void RingBuffer::add(const double& value) { GWSYNCHRONIZED(&bufLocker); if (value < smallest || value > largest) { buffer[head] = MAX_VAL; // Store MAX_VAL if value is out of range } else { - buffer[head] = value; + buffer[head] = static_cast(std::round(value * mltplr)); } last = head; @@ -115,63 +126,63 @@ void RingBuffer::add(const T& value) is_Full = true; } } - + // Serial.printf("Ringbuffer: value %.3f, multiplier: %.1f, buffer: %d\n", value, mltplr, buffer[head]); head = (head + 1) % capacity; } // Get value at specific position (0-based index from oldest to newest) template -T RingBuffer::get(size_t index) const +double RingBuffer::get(size_t index) const { GWSYNCHRONIZED(&bufLocker); if (isEmpty() || index < 0 || index >= count) { - return MAX_VAL; + return dblMAX_VAL; } size_t realIndex = (first + index) % capacity; - return buffer[realIndex]; + return static_cast(buffer[realIndex] / mltplr); } // Operator[] for convenient access (same as get()) template -T RingBuffer::operator[](size_t index) const +double RingBuffer::operator[](size_t index) const { return get(index); } // Get the first (oldest) value in the buffer template -T RingBuffer::getFirst() const +double RingBuffer::getFirst() const { if (isEmpty()) { - return MAX_VAL; + return dblMAX_VAL; } return get(0); } // Get the last (newest) value in the buffer template -T RingBuffer::getLast() const +double RingBuffer::getLast() const { if (isEmpty()) { - return MAX_VAL; + return dblMAX_VAL; } return get(count - 1); } // Get the lowest value in the buffer template -T RingBuffer::getMin() const +double RingBuffer::getMin() const { if (isEmpty()) { - return MAX_VAL; + return dblMAX_VAL; } - T minVal = MAX_VAL; - T value; + double minVal = dblMAX_VAL; + double value; for (size_t i = 0; i < count; i++) { value = get(i); - if (value < minVal && value != MAX_VAL) { + if (value < minVal && value != dblMAX_VAL) { minVal = value; } } @@ -180,19 +191,19 @@ T RingBuffer::getMin() const // Get minimum value of the last values of buffer template -T RingBuffer::getMin(size_t amount) const +double RingBuffer::getMin(size_t amount) const { if (isEmpty() || amount <= 0) { - return MAX_VAL; + return dblMAX_VAL; } if (amount > count) amount = count; - T minVal = MAX_VAL; - T value; + double minVal = dblMAX_VAL; + double value; for (size_t i = 0; i < amount; i++) { value = get(count - 1 - i); - if (value < minVal && value != MAX_VAL) { + if (value < minVal && value != dblMAX_VAL) { minVal = value; } } @@ -201,75 +212,81 @@ T RingBuffer::getMin(size_t amount) const // Get the highest value in the buffer template -T RingBuffer::getMax() const +double RingBuffer::getMax() const { if (isEmpty()) { - return MAX_VAL; + return dblMAX_VAL; } - T maxVal = MIN_VAL; - T value; + double maxVal = dblMIN_VAL; + double value; for (size_t i = 0; i < count; i++) { value = get(i); - if (value > maxVal && value != MAX_VAL) { + if (value > maxVal && value != dblMAX_VAL) { maxVal = value; } } + if (maxVal == dblMIN_VAL) { // no change of initial value -> buffer has only invalid values (MAX_VAL) + maxVal = dblMAX_VAL; + } return maxVal; } // Get maximum value of the last values of buffer template -T RingBuffer::getMax(size_t amount) const +double RingBuffer::getMax(size_t amount) const { if (isEmpty() || amount <= 0) { - return MAX_VAL; + return dblMAX_VAL; } if (amount > count) amount = count; - T maxVal = MIN_VAL; - T value; + double maxVal = dblMIN_VAL; + double value; for (size_t i = 0; i < amount; i++) { value = get(count - 1 - i); - if (value > maxVal && value != MAX_VAL) { + if (value > maxVal && value != dblMAX_VAL) { maxVal = value; } } + if (maxVal == dblMIN_VAL) { // no change of initial value -> buffer has only invalid values (MAX_VAL) + maxVal = dblMAX_VAL; + } return maxVal; } // Get mid value between and value in the buffer template -T RingBuffer::getMid() const +double RingBuffer::getMid() const { if (isEmpty()) { - return MAX_VAL; + return dblMAX_VAL; } - return (getMin() + getMax()) / static_cast(2); + return (getMin() + getMax()) / 2; } // Get mid value between and value of the last values of buffer template -T RingBuffer::getMid(size_t amount) const +double RingBuffer::getMid(size_t amount) const { if (isEmpty() || amount <= 0) { - return MAX_VAL; + return dblMAX_VAL; } if (amount > count) amount = count; - return (getMin(amount) + getMax(amount)) / static_cast(2); + return (getMin(amount) + getMax(amount)) / 2; } // Get the median value in the buffer template -T RingBuffer::getMedian() const +double RingBuffer::getMedian() const { if (isEmpty()) { - return MAX_VAL; + return dblMAX_VAL; } // Create a temporary vector with current valid elements @@ -285,20 +302,20 @@ T RingBuffer::getMedian() const if (count % 2 == 1) { // Odd number of elements - return temp[count / 2]; + return static_cast(temp[count / 2]); } else { // Even number of elements - return average of middle two // Note: For integer types, this truncates. For floating point, it's exact. - return (temp[count / 2 - 1] + temp[count / 2]) / 2; + return static_cast((temp[count / 2 - 1] + temp[count / 2]) / 2); } } // Get the median value of the last values of buffer template -T RingBuffer::getMedian(size_t amount) const +double RingBuffer::getMedian(size_t amount) const { if (isEmpty() || amount <= 0) { - return MAX_VAL; + return dblMAX_VAL; } if (amount > count) amount = count; @@ -308,7 +325,7 @@ T RingBuffer::getMedian(size_t amount) const temp.reserve(amount); for (size_t i = 0; i < amount; i++) { - temp.push_back(get(i)); + temp.push_back(get(count - 1 - i)); } // Sort to find median @@ -316,11 +333,11 @@ T RingBuffer::getMedian(size_t amount) const if (amount % 2 == 1) { // Odd number of elements - return temp[amount / 2]; + return static_cast(temp[amount / 2]); } else { // Even number of elements - return average of middle two // Note: For integer types, this truncates. For floating point, it's exact. - return (temp[amount / 2 - 1] + temp[amount / 2]) / 2; + return static_cast((temp[amount / 2 - 1] + temp[amount / 2]) / 2); } } @@ -368,16 +385,16 @@ bool RingBuffer::isFull() const // Get lowest possible value for buffer template -T RingBuffer::getMinVal() const +double RingBuffer::getMinVal() const { - return MIN_VAL; + return dblMIN_VAL; } // Get highest possible value for buffer; used for unset/invalid buffer data template -T RingBuffer::getMaxVal() const +double RingBuffer::getMaxVal() const { - return MAX_VAL; + return dblMAX_VAL; } // Clear buffer @@ -405,19 +422,41 @@ void RingBuffer::resize(size_t newSize) is_Full = false; buffer.clear(); + buffer.reserve(newSize); buffer.resize(newSize, MAX_VAL); } -// Get all current values as a vector +// Get all current values in native buffer format as a vector template -std::vector RingBuffer::getAllValues() const +std::vector RingBuffer::getAllValues() const { - std::vector result; + std::vector result; result.reserve(count); for (size_t i = 0; i < count; i++) { result.push_back(get(i)); } + return result; +} + +// Get last values in native buffer format as a vector +template +std::vector RingBuffer::getAllValues(size_t amount) const +{ + std::vector result; + + if (isEmpty() || amount <= 0) { + return result; + } + if (amount > count) + amount = count; + + result.reserve(amount); + + for (size_t i = 0; i < amount; i++) { + result.push_back(get(count - 1 - i)); + } + return result; } \ No newline at end of file diff --git a/lib/obp60task/OBPSensorTask.cpp b/lib/obp60task/OBPSensorTask.cpp index 8cde7b7..4bbea6d 100644 --- a/lib/obp60task/OBPSensorTask.cpp +++ b/lib/obp60task/OBPSensorTask.cpp @@ -457,6 +457,7 @@ void sensorTask(void *param){ // Get current RTC date and time all 500ms if (millis() > starttime12 + 500) { starttime12 = millis(); + // Send date and time from RTC chip if GPS not ready if (rtcOn == "DS1388" && RTC_ready) { DateTime dt = ds1388.now(); sensors.rtcTime.tm_year = dt.year() - 1900; // Save values in SensorData @@ -496,7 +497,31 @@ void sensorTask(void *param){ } } - // Send supply voltage value all 1s + // Send 1Wire data for all temperature sensors to N2K all 2s + if(millis() > starttime13 + 2000 && String(oneWireOn) == "DS18B20" && oneWire_ready == true){ + starttime13 = millis(); + float tempC; + ds18b20.requestTemperatures(); // Collect all temperature values (max.8) + for(int i=0;igetLogger()->logDebug(GwLog::DEBUG,"DS18B20-%1d Temp: %.1f",i,tempC); + SetN2kPGN130316(N2kMsg, 0, i, N2kts_OutsideTemperature, CToKelvin(tempC), N2kDoubleNA); + api->sendN2kMessage(N2kMsg); + } + } + } + loopCounter++; + } + + // Send supply voltage value to N2K all 1s if(millis() > starttime5 + 1000 && String(powsensor1) == "off"){ starttime5 = millis(); float rawVoltage = 0; // Default value @@ -566,7 +591,7 @@ void sensorTask(void *param){ #endif } - // Send data from environment sensor all 2s + // Send data from environment sensor to N2K all 2s if(millis() > starttime6 + 2000){ starttime6 = millis(); @@ -636,7 +661,7 @@ void sensorTask(void *param){ } } - // Send rotation angle all 500ms + // Send rotation angle to N2K all 500ms if(millis() > starttime7 + 500){ starttime7 = millis(); double rotationAngle=0; @@ -684,7 +709,7 @@ void sensorTask(void *param){ } } - // Send battery power value all 1s + // Send battery power value to N2K all 1s if(millis() > starttime8 + 1000 && (String(powsensor1) == "INA219" || String(powsensor1) == "INA226")){ starttime8 = millis(); if(String(powsensor1) == "INA226" && INA226_1_ready == true){ @@ -726,7 +751,7 @@ void sensorTask(void *param){ } } - // Send solar power value all 1s + // Send solar power value to N2K all 1s if(millis() > starttime9 + 1000 && (String(powsensor2) == "INA219" || String(powsensor2) == "INA226")){ starttime9 = millis(); if(String(powsensor2) == "INA226" && INA226_2_ready == true){ @@ -756,7 +781,7 @@ void sensorTask(void *param){ } } - // Send generator power value all 1s + // Send generator power value to N2K all 1s if(millis() > starttime10 + 1000 && (String(powsensor3) == "INA219" || String(powsensor3) == "INA226")){ starttime10 = millis(); if(String(powsensor3) == "INA226" && INA226_3_ready == true){ diff --git a/lib/obp60task/OBPcharts.cpp b/lib/obp60task/OBPcharts.cpp new file mode 100644 index 0000000..c646f4b --- /dev/null +++ b/lib/obp60task/OBPcharts.cpp @@ -0,0 +1,808 @@ +// Function lib for display of boat data in various chart formats +#include "OBPcharts.h" +#include "OBPDataOperations.h" +#include "OBPRingBuffer.h" + +std::map Chart::dfltChrtDta = { + { "formatWind", { 60.0 * DEG_TO_RAD, 10.0 * DEG_TO_RAD } }, // default course range 60 degrees + { "formatCourse", { 60.0 * DEG_TO_RAD, 10.0 * DEG_TO_RAD } }, // default course range 60 degrees + { "formatKnots", { 7.71, 2.56 } }, // default speed range in m/s + { "formatDepth", { 15.0, 5.0 } }, // default depth range in m + { "kelvinToC", { 30.0, 5.0 } } // default temp range in °C/K +}; + +// --- Class Chart --------------- + +// Chart - object holding the actual chart, incl. data buffer and format definition +// Parameters: the history data buffer for the chart +// default range of chart, e.g. 30 = [0..30] +// common program data; required for logger and color data +// flag to indicate if simulation data is active +Chart::Chart(RingBuffer& dataBuf, double dfltRng, CommonData& common, bool useSimuData) + : dataBuf(dataBuf) + , dfltRng(dfltRng) + , commonData(&common) + , useSimuData(useSimuData) +{ + logger = commonData->logger; + fgColor = commonData->fgcolor; + bgColor = commonData->bgcolor; + + // display dimensions (avoid calling width()/height() on incomplete LGFX type) + dWidth = epd->width(); + dHeight = epd->height(); + + dataBuf.getMetaData(dbName, dbFormat); + dbMIN_VAL = dataBuf.getMinVal(); + dbMAX_VAL = dataBuf.getMaxVal(); + bufSize = dataBuf.getCapacity(); + + // Initialize chart data format; shorter version of standard format indicator + if (dbFormat == "formatCourse" || dbFormat == "formatWind" || dbFormat == "formatRot") { + chrtDataFmt = WIND; // Chart is showing data of course / wind format + } else if (dbFormat == "formatRot") { + chrtDataFmt = ROTATION; // Chart is showing data of rotational format + } else if (dbFormat == "formatKnots") { + chrtDataFmt = SPEED; // Chart is showing data of speed or windspeed format + } else if (dbFormat == "formatDepth") { + chrtDataFmt = DEPTH; // Chart ist showing data of format + } else if (dbFormat == "kelvinToC") { + chrtDataFmt = TEMPERATURE; // Chart ist showing data of format + } else { + chrtDataFmt = OTHER; // Chart is showing any other data format + } + + // "0" value is the same for any data format but for user defined temperature format + zeroValue = 0.0; + if (chrtDataFmt == TEMPERATURE) { + tempFormat = commonData->config->getString(commonData->config->tempFormat); // [K|°C|°F] + if (tempFormat == "K") { + zeroValue = 0.0; + } else if (tempFormat == "C") { + zeroValue = 273.15; + } else if (tempFormat == "F") { + zeroValue = 255.37; + } + } + + // Read default range and range step for this chart type + if (dfltChrtDta.count(dbFormat)) { + dfltRng = dfltChrtDta[dbFormat].range; + rngStep = dfltChrtDta[dbFormat].step; + } else { + dfltRng = 15.0; + rngStep = 5.0; + } + + // Initialize chart range values + chrtMin = zeroValue; + chrtMax = chrtMin + dfltRng; + chrtMid = (chrtMin + chrtMax) / 2; + chrtRng = dfltRng; + recalcRngMid = true; // initialize and chart borders on first screen call + + LOG_DEBUG(GwLog::DEBUG, "Chart Init: dWidth: %d, dHeight: %d, timAxis: %d, valAxis: %d, cRoot {x,y}: %d, %d, dbname: %s, rngStep: %.4f, chrtDataFmt: %d", + dWidth, dHeight, timAxis, valAxis, cRoot.x, cRoot.y, dbName, rngStep, chrtDataFmt); +}; + +Chart::~Chart() +{ +} + +// Perform all actions to draw chart +// Parameters: : chart timeline direction: 'H' = horizontal, 'V' = vertical +// : chart size: [0] = full size, [1] = half size left/top, [2] half size right/bottom +// : chart timeline interval +// ; print data name on horizontal half chart [true|false] +// : print current boat data value [true|false] +// : current boat data value; used only for test on valid data +void Chart::showChrt(char chrtDir, int8_t chrtSz, const int8_t chrtIntv, bool prntName, bool showCurrValue, GwApi::BoatValue currValue) +{ + if (!setChartDimensions(chrtDir, chrtSz)) { + return; // wrong chart dimension parameters + } + + drawChrt(chrtDir, chrtIntv, currValue); + drawChrtTimeAxis(chrtDir, chrtSz, chrtIntv); + drawChrtValAxis(chrtDir, chrtSz, prntName); + + if (!bufDataValid) { // No valid data available + prntNoValidData(chrtDir); + return; + } + + if (showCurrValue) { // show latest value from history buffer; this should be the most current one + currValue.value = dataBuf.getLast(); + currValue.valid = currValue.value != dbMAX_VAL; + prntCurrValue(chrtDir, currValue); + } +} + +// define dimensions and start points for chart +bool Chart::setChartDimensions(const char direction, const int8_t size) +{ + if ((direction != HORIZONTAL && direction != VERTICAL) || (size < 0 || size > 2)) { + LOG_DEBUG(GwLog::ERROR, "obp60:setChartDimensions %s: wrong parameters", dataBuf.getName()); + return false; + } + + if (direction == HORIZONTAL) { + // horizontal chart timeline direction + timAxis = dWidth - 1; + switch (size) { + case 0: + valAxis = dHeight - top - bottom; + cRoot = { 0, top - 1 }; + break; + case 1: + valAxis = (dHeight - top - bottom) / 2 - hGap; + cRoot = { 0, top - 1 }; + break; + case 2: + valAxis = (dHeight - top - bottom) / 2 - hGap; + cRoot = { 0, top + (valAxis + hGap) + hGap - 1 }; + break; + } + + } else if (direction == VERTICAL) { + // vertical chart timeline direction + timAxis = dHeight - top - bottom; + switch (size) { + case 0: + valAxis = dWidth - 1; + cRoot = { 0, top - 1 }; + break; + case 1: + valAxis = dWidth / 2 - vGap; + cRoot = { 0, top - 1 }; + break; + case 2: + valAxis = dWidth / 2 - vGap; + cRoot = { dWidth / 2 + vGap - 1, top - 1 }; + break; + } + } + //LOG_DEBUG(GwLog::DEBUG, "obp60:setChartDimensions %s: direction: %c, size: %d, dWidth: %d, dHeight: %d, timAxis: %d, valAxis: %d, cRoot{%d, %d}, top: %d, bottom: %d, hGap: %d, vGap: %d", + // dataBuf.getName(), direction, size, dWidth, dHeight, timAxis, valAxis, cRoot.x, cRoot.y, top, bottom, hGap, vGap); + return true; +} + +// draw chart +void Chart::drawChrt(const char chrtDir, const int8_t chrtIntv, GwApi::BoatValue& currValue) +{ + double chrtScale; // Scale for data values in pixels per value + + getBufferStartNSize(chrtIntv); + + // LOG_DEBUG(GwLog::DEBUG, "Chart:drawChart: min: %.1f, mid: %.1f, max: %.1f, rng: %.1f", chrtMin, chrtMid, chrtMax, chrtRng); + calcChrtBorders(chrtMin, chrtMid, chrtMax, chrtRng); + chrtScale = double(valAxis) / chrtRng; // Chart scale: pixels per value step + // LOG_DEBUG(GwLog::DEBUG, "Chart:drawChart: min: %.1f, mid: %.1f, max: %.1f, rng: %.1f", chrtMin, chrtMid, chrtMax, chrtRng); + + // Do we have valid buffer data? + if (dataBuf.getMax() == dbMAX_VAL) { // only values in buffer -> no valid wind data available + bufDataValid = false; + return; + + } else if (currValue.valid || useSimuData) { // latest boat data valid or simulation mode + numNoData = 0; // reset data error counter + bufDataValid = true; + + } else { // currently no valid data + numNoData++; + bufDataValid = true; + + if (numNoData > THRESHOLD_NO_DATA) { // If more than 4 invalid values in a row, flag for invalid data + bufDataValid = false; + return; + } + } + + drawChartLines(chrtDir, chrtIntv, chrtScale); +} + +// Identify buffer size and buffer start position for chart +void Chart::getBufferStartNSize(const int8_t chrtIntv) +{ + count = dataBuf.getCurrentSize(); + currIdx = dataBuf.getLastIdx(); + numAddedBufVals = (currIdx - lastAddedIdx + bufSize) % bufSize; // Number of values added to buffer since last display + + if (chrtIntv != oldChrtIntv || count == 1) { + // new data interval selected by user; this is only x * 230 values instead of 240 seconds (4 minutes) per interval step + numBufVals = min(count, (timAxis - MIN_FREE_VALUES) * chrtIntv); // keep free or release MIN_FREE_VALUES on chart for plotting of new values + bufStart = max(0, count - numBufVals); + lastAddedIdx = currIdx; + oldChrtIntv = chrtIntv; + + } else { + numBufVals = numBufVals + numAddedBufVals; + lastAddedIdx = currIdx; + if (count == bufSize) { + bufStart = max(0, bufStart - numAddedBufVals); + } + } +} + +// check and adjust chart range and set range borders and range middle +void Chart::calcChrtBorders(double& rngMin, double& rngMid, double& rngMax, double& rng) +{ + if (chrtDataFmt == WIND || chrtDataFmt == ROTATION) { + + if (chrtDataFmt == ROTATION) { + // if chart data is of type 'rotation', we want to have always to be '0' + rngMid = 0; + + } else { // WIND: Chart data is of type 'course' or 'wind' + + // initialize if data buffer has just been started filling + if ((count == 1 && rngMid == 0) || rngMid == dbMAX_VAL) { + recalcRngMid = true; + } + + if (recalcRngMid) { + // Set rngMid + + rngMid = dataBuf.getMid(numBufVals); + + if (rngMid == dbMAX_VAL) { + rngMid = 0; + } else { + rngMid = std::round(rngMid / rngStep) * rngStep; // Set new center value; round to next value + + // Check if range between 'min' and 'max' is > 180° or crosses '0' + rngMin = dataBuf.getMin(numBufVals); + rngMax = dataBuf.getMax(numBufVals); + rng = (rngMax >= rngMin ? rngMax - rngMin : M_TWOPI - rngMin + rngMax); + rng = std::max(rng, dfltRng); // keep at least default chart range + + if (rng > M_PI) { // If wind range > 180°, adjust wndCenter to smaller wind range end + rngMid = WindUtils::to2PI(rngMid + M_PI); + } + } + recalcRngMid = false; // Reset flag for determination + + // LOG_DEBUG(GwLog::DEBUG, "calcChrtRange: rngMin: %.1f°, rngMid: %.1f°, rngMax: %.1f°, rng: %.1f°, rngStep: %.1f°", rngMin * RAD_TO_DEG, rngMid * RAD_TO_DEG, rngMax * RAD_TO_DEG, + // rng * RAD_TO_DEG, rngStep * RAD_TO_DEG); + } + } + + // check and adjust range between left, mid, and right chart limit + double halfRng = rng / 2.0; // we calculate with range between and edges + double tmpRng = getAngleRng(rngMid, numBufVals); + tmpRng = (tmpRng == dbMAX_VAL ? 0 : std::ceil(tmpRng / rngStep) * rngStep); + + // LOG_DEBUG(GwLog::DEBUG, "calcChrtBorders: tmpRng: %.1f°, halfRng: %.1f°", tmpRng * RAD_TO_DEG, halfRng * RAD_TO_DEG); + + if (tmpRng > halfRng) { // expand chart range to new value + halfRng = tmpRng; + } + + else if (tmpRng + rngStep < halfRng) { // Contract chart range for higher resolution if possible + halfRng = std::max(dfltRng / 2.0, tmpRng); + } + + rngMin = WindUtils::to2PI(rngMid - halfRng); + rngMax = (halfRng < M_PI ? rngMid + halfRng : rngMid + halfRng - (M_TWOPI / 360)); // if chart range is 360°, then make 1° smaller than + rngMax = WindUtils::to2PI(rngMax); + + rng = halfRng * 2.0; + + // LOG_DEBUG(GwLog::DEBUG, "calcChrtBorders: rngMin: %.1f°, rngMid: %.1f°, rngMax: %.1f°, tmpRng: %.1f°, rng: %.1f°, rngStep: %.1f°", rngMin * RAD_TO_DEG, rngMid * RAD_TO_DEG, rngMax * RAD_TO_DEG, + // tmpRng * RAD_TO_DEG, rng * RAD_TO_DEG, rngStep * RAD_TO_DEG); + + } else { // chart data is of any other type + + double currMinVal = dataBuf.getMin(numBufVals); + double currMaxVal = dataBuf.getMax(numBufVals); + + if (currMinVal == dbMAX_VAL || currMaxVal == dbMAX_VAL) { + return; // no valid data + } + + // check if current chart border have to be adjusted + if (currMinVal < rngMin || (currMinVal > (rngMin + rngStep))) { // decrease rngMin if required or increase if lowest value is higher than old rngMin + rngMin = std::floor(currMinVal / rngStep) * rngStep; // align low range to lowest buffer value and nearest range interval + } + if ((currMaxVal > rngMax) || (currMaxVal < (rngMax - rngStep))) { // increase rngMax if required or decrease if lowest value is lower than old rngMax + rngMax = std::ceil(currMaxVal / rngStep) * rngStep; + } + + // Chart range starts at least at '0' if minimum data value allows it + if (rngMin > zeroValue && dbMIN_VAL <= zeroValue) { + rngMin = zeroValue; + } + + // ensure minimum chart range in user format + if ((rngMax - rngMin) < dfltRng) { + rngMax = rngMin + dfltRng; + } + + rngMid = (rngMin + rngMax) / 2.0; + rng = rngMax - rngMin; + + // LOG_DEBUG(GwLog::DEBUG, "calcChrtRange-end: currMinVal: %.1f, currMaxVal: %.1f, rngMin: %.1f, rngMid: %.1f, rngMax: %.1f, rng: %.1f, rngStep: %.1f, zeroValue: %.1f, dbMIN_VAL: %.1f", + // currMinVal, currMaxVal, rngMin, rngMid, rngMax, rng, rngStep, zeroValue, dbMIN_VAL); + } +} + +// Draw chart graph +void Chart::drawChartLines(const char direction, const int8_t chrtIntv, const double chrtScale) +{ + double chrtVal; // Current data value + Pos point, prevPoint; // current and previous chart point + + for (int i = 0; i < (numBufVals / chrtIntv); i++) { + + chrtVal = dataBuf.get(bufStart + (i * chrtIntv)); // show the latest wind values in buffer; keep 1st value constant in a rolling buffer + + if (chrtVal == dbMAX_VAL) { + chrtPrevVal = dbMAX_VAL; + } else { + + point = setCurrentChartPoint(i, direction, chrtVal, chrtScale); + + // if (i >= (numBufVals / chrtIntv) - 5) // log chart data of 1 line (adjust for test purposes) + // LOG_DEBUG(GwLog::DEBUG, "PageWindPlot Chart: i: %d, chrtVal: %.2f, chrtMin: %.2f, {x,y} {%d,%d}", i, chrtVal, chrtMin, x, y); + + if ((i == 0) || (chrtPrevVal == dbMAX_VAL)) { + // just a dot for 1st chart point or after some invalid values + prevPoint = point; + + } else if (chrtDataFmt == WIND || chrtDataFmt == ROTATION) { + // cross borders check for degree values; shift values to [-PI..0..PI]; when crossing borders, range is 2x PI degrees + + double normCurrVal = WindUtils::to2PI(chrtVal - chrtMin); + double normPrevVal = WindUtils::to2PI(chrtPrevVal - chrtMin); + // Check if pixel positions are far apart (crossing chart boundary); happens when one value is near chrtMax and the other near chrtMin + bool crossedBorders = std::abs(normCurrVal - normPrevVal) > (chrtRng / 2.0); + + if (crossedBorders) { // If current value crosses chart borders compared to previous value, split line + // LOG_DEBUG(GwLog::DEBUG, "PageWindPlot Chart: crossedBorders: %d, chrtVal: %.2f, chrtPrevVal: %.2f", crossedBorders, chrtVal, chrtPrevVal); + bool wrappingFromHighToLow = normCurrVal < normPrevVal; // Determine which edge we're crossing + + if (direction == HORIZONTAL) { + int ySplit = wrappingFromHighToLow ? (cRoot.y + valAxis) : cRoot.y; + drawBoldLine(prevPoint.x, prevPoint.y, point.x, ySplit); + prevPoint.y = wrappingFromHighToLow ? cRoot.y : (cRoot.y + valAxis); + + } else { // vertical chart + int xSplit = wrappingFromHighToLow ? (cRoot.x + valAxis) : cRoot.x; + drawBoldLine(prevPoint.x, prevPoint.y, xSplit, point.y); + prevPoint.x = wrappingFromHighToLow ? cRoot.x : (cRoot.x + valAxis); + } + } + } + + if (chrtDataFmt == DEPTH) { + if (direction == HORIZONTAL) { // horizontal chart + drawBoldLine(point.x, point.y, point.x, cRoot.y + valAxis); + } else { // vertical chart + drawBoldLine(point.x, point.y, cRoot.x + valAxis, point.y); + } + } else { + drawBoldLine(prevPoint.x, prevPoint.y, point.x, point.y); + } + + chrtPrevVal = chrtVal; + prevPoint = point; + } + + // Reaching chart area top end + if (i >= timAxis - 1) { + oldChrtIntv = 0; // force reset of buffer start and number of values to show in next display loop + + if (chrtDataFmt == WIND) { // degree of course or wind + recalcRngMid = true; + LOG_DEBUG(GwLog::DEBUG, "PageWindPlot: chart end: timAxis: %d, i: %d, bufStart: %d, numBufVals: %d, recalcRngCntr: %d", timAxis, i, bufStart, numBufVals, recalcRngMid); + } + break; + } + + taskYIELD(); // we run for 50-150ms; be polite to other tasks with same priority + } +} + +// Set current chart point to draw +Pos Chart::setCurrentChartPoint(const int i, const char direction, const double chrtVal, const double chrtScale) +{ + Pos currentPoint; + + if (direction == HORIZONTAL) { + currentPoint.x = cRoot.x + i; // Position in chart area + + if (chrtDataFmt == WIND || chrtDataFmt == ROTATION) { // degree type value + currentPoint.y = cRoot.y + static_cast((WindUtils::to2PI(chrtVal - chrtMin) * chrtScale) + 0.5); // calculate chart point and round + } else if (chrtDataFmt == SPEED or chrtDataFmt == TEMPERATURE) { // speed or temperature data format -> print low values at bottom + currentPoint.y = cRoot.y + valAxis - static_cast(((chrtVal - chrtMin) * chrtScale) + 0.5); // calculate chart point and round + } else { // any other data format + currentPoint.y = cRoot.y + static_cast(((chrtVal - chrtMin) * chrtScale) + 0.5); // calculate chart point and round + } + + } else { // vertical chart + currentPoint.y = cRoot.y + timAxis - i; // Position in chart area + + if (chrtDataFmt == WIND || chrtDataFmt == ROTATION) { // degree type value + currentPoint.x = cRoot.x + static_cast((WindUtils::to2PI(chrtVal - chrtMin) * chrtScale) + 0.5); // calculate chart point and round + } else { + currentPoint.x = cRoot.x + static_cast(((chrtVal - chrtMin) * chrtScale) + 0.5); // calculate chart point and round + } + } + + return currentPoint; +} + +// chart time axis label + lines +void Chart::drawChrtTimeAxis(const char chrtDir, const int8_t chrtSz, const int8_t chrtIntv) +{ + float axSlots, intv, i; + char sTime[6]; + int timeRng = chrtIntv * 4; // chart time interval: [1] 4 min., [2] 8 min., [3] 12 min., [4] 16 min., [8] 32 min. + + epd->setFont(&Ubuntu_Bold8pt8b); + epd->setTextColor(fgColor); + + axSlots = 5; // number of axis labels + intv = timAxis / (axSlots - 1); // minutes per chart axis interval (interval is 1 less than axSlots) + i = timeRng; // Chart axis label start at -32, -16, -12, ... minutes + + if (chrtDir == HORIZONTAL) { + epd->fillRect(0, cRoot.y, dWidth, 2, fgColor); + + for (float j = 0; j < timAxis - 1; j += intv) { // fill time axis with values but keep area free on right hand side for value label + + // draw text with appropriate offset + int tOffset = j == 0 ? 13 : -4; + snprintf(sTime, sizeof(sTime), "-%.0f", i); + drawTextCenter(cRoot.x + j + tOffset, cRoot.y - 8, sTime); + epd->drawLine(cRoot.x + j, cRoot.y, cRoot.x + j, cRoot.y + 5, fgColor); // draw short vertical time mark + + i -= chrtIntv; + } + + } else { // vertical chart + + for (float j = intv; j < timAxis - 1; j += intv) { // don't print time label at upper and lower end of time axis + + i -= chrtIntv; // we start not at top chart position + snprintf(sTime, sizeof(sTime), "-%.0f", i); + epd->drawLine(cRoot.x, cRoot.y + j, cRoot.x + valAxis, cRoot.y + j, fgColor); // Grid line + + if (chrtSz == FULL_SIZE) { // full size chart + epd->fillRect(0, cRoot.y + j - 9, 32, 15, bgColor); // clear small area to remove potential chart lines + epd->setCursor((4 - strlen(sTime)) * 7, cRoot.y + j + 3); // time value; print left screen; value right-formated + epd->printf("%s", sTime); // Range value + } else if (chrtSz == HALF_SIZE_RIGHT) { // half size chart; right side + drawTextCenter(dWidth / 2, cRoot.y + j, sTime); // time value; print mid screen + } + } + } +} + +// chart value axis labels + lines +void Chart::drawChrtValAxis(const char chrtDir, const int8_t chrtSz, bool prntName) +{ + const GFXfont* font; + constexpr bool NO_LABEL = false; + constexpr bool LABEL = true; + + epd->setTextColor(fgColor); + + if (chrtDir == HORIZONTAL) { + + if (chrtSz == FULL_SIZE) { + + font = &Ubuntu_Bold12pt8b; + + // print buffer data name on right hand side of time axis (max. size 5 characters) + epd->setFont(font); + drawTextRalign(cRoot.x + timAxis, cRoot.y - 3, dbName.substring(0, 5)); + + if (chrtDataFmt == WIND) { + prntHorizChartThreeValueAxisLabel(font); + return; + } + + // for any other data formats print multiple axis value lines on full charts + prntHorizChartMultiValueAxisLabel(font); + return; + + } else { // half size chart -> just print edge values + middle chart line + + font = &Ubuntu_Bold10pt8b; + + if (prntName) { + // print buffer data name on right hand side of time axis (max. size 5 characters) + epd->setFont(font); + drawTextRalign(cRoot.x + timAxis, cRoot.y - 3, dbName.substring(0, 5)); + } + + prntHorizChartThreeValueAxisLabel(font); + return; + } + + } else { // vertical chart + + if (chrtSz == FULL_SIZE) { + font = &Ubuntu_Bold12pt8b; + epd->setFont(font); // use larger font + drawTextRalign(cRoot.x + (valAxis * 0.42), cRoot.y - 2, dbName.substring(0, 6)); // print buffer data name (max. size 5 characters) + + } else { + + font = &Ubuntu_Bold10pt8b; + } + + prntVerticChartThreeValueAxisLabel(font); + } +} + +// Print current data value +void Chart::prntCurrValue(const char direction, GwApi::BoatValue& currValue) +{ + const int xPosVal = (direction == HORIZONTAL) ? cRoot.x + (timAxis / 2) - 56 : cRoot.x + 32; + const int yPosVal = (direction == HORIZONTAL) ? cRoot.y + valAxis - 7 : cRoot.y + timAxis - 7; + + FormattedData frmtDbData = commonData->fmt->formatValue(&currValue, *commonData, NO_SIMUDATA); + String sdbValue = frmtDbData.svalue; // value as formatted string + String dbUnit = frmtDbData.unit; // Unit of value; limit length to 3 characters + + epd->fillRect(xPosVal - 1, yPosVal - 35, 128, 41, bgColor); // Clear area for TWS value + epd->drawRect(xPosVal, yPosVal - 34, 126, 40, fgColor); // Draw box for TWS value + epd->setFont(&DSEG7Classic_BoldItalic16pt7b); + epd->setCursor(xPosVal + 1, yPosVal); + epd->print(sdbValue); // value + + epd->setFont(&Ubuntu_Bold10pt8b); + epd->setCursor(xPosVal + 76, yPosVal - 17); + epd->print(dbName.substring(0, 3)); // Name, limited to 3 characters + + epd->setFont(&Ubuntu_Bold8pt8b); + epd->setCursor(xPosVal + 76, yPosVal + 0); + epd->print(dbUnit); // Unit +} + +// print message for no valid data availabletemplate +void Chart::prntNoValidData(const char direction) +{ + Pos p; + + epd->setFont(&Ubuntu_Bold10pt8b); + + if (direction == HORIZONTAL) { + p.x = cRoot.x + (timAxis / 2); + p.y = cRoot.y + (valAxis / 2) - 10; + } else { + p.x = cRoot.x + (valAxis / 2); + p.y = cRoot.y + (timAxis / 2) - 10; + } + + epd->fillRect(p.x - 37, p.y - 10, 78, 24, bgColor); // Clear area for message + drawTextCenter(p.x, p.y, "No data"); + + LOG_DEBUG(GwLog::LOG, "Page chart <%s>: No valid data available", dbName); +} + +// Get maximum difference of last of dataBuf ringbuffer values to center chart; for angle data only +double Chart::getAngleRng(const double center, size_t amount) +{ + size_t count = dataBuf.getCurrentSize(); + + if (dataBuf.isEmpty() || amount <= 0) { + return dbMAX_VAL; + } + if (amount > count) + amount = count; + + double value = 0; + double range = 0; + double maxRng = dbMIN_VAL; + + // Start from the newest value (last) and go backwards x times + for (size_t i = 0; i < amount; i++) { + value = dataBuf.get(count - 1 - i); + + if (value == dbMAX_VAL) { + continue; // ignore invalid values + } + + range = abs(fmod((value - center + (M_TWOPI + M_PI)), M_TWOPI) - M_PI); + if (range > maxRng) + maxRng = range; + } + + if (maxRng > M_PI) { + maxRng = M_PI; + } + + return (maxRng != dbMIN_VAL ? maxRng : dbMAX_VAL); // Return range from to +} + + // print value axis label with only three values: top, mid, and bottom for vertical chart + void Chart::prntVerticChartThreeValueAxisLabel(const GFXfont* font) +{ + double cVal; + char sVal[7]; + + epd->fillRect(cRoot.x, cRoot.y, valAxis, 2, fgColor); // top chart line + epd->setFont(font); + + cVal = chrtMin; + cVal = commonData->fmt->convertValue(cVal, dbName, dbFormat, *commonData); // value (converted) + snprintf(sVal, sizeof(sVal), "%.0f", round(cVal)); + epd->setCursor(cRoot.x, cRoot.y - 2); + epd->printf("%s", sVal); // Range low end + + cVal = chrtMid; + cVal = commonData->fmt->convertValue(cVal, dbName, dbFormat, *commonData); // value (converted) + snprintf(sVal, sizeof(sVal), "%.0f", round(cVal)); + drawTextCenter(cRoot.x + (valAxis / 2), cRoot.y - 9, sVal); // Range mid end + + cVal = chrtMax; + cVal = commonData->fmt->convertValue(cVal, dbName, dbFormat, *commonData); // value (converted) + snprintf(sVal, sizeof(sVal), "%.0f", round(cVal)); + drawTextRalign(cRoot.x + valAxis - 2, cRoot.y - 2, sVal); // Range high end + + // draw vertical grid lines for each axis label + for (int j = 0; j <= valAxis; j += (valAxis / 2)) { + epd->drawLine(cRoot.x + j, cRoot.y, cRoot.x + j, cRoot.y + timAxis, fgColor); + } +} + +// print value axis label with only three values: top, mid, and bottom for horizontal chart +void Chart::prntHorizChartThreeValueAxisLabel(const GFXfont* font) +{ + double axLabel; + double chrtMin, chrtMid, chrtMax; + int xOffset, yOffset; // offset for text position of x axis label for different font sizes + String sVal; + + if (font == &Ubuntu_Bold10pt8b) { + xOffset = 39; + yOffset = 16; + } else if (font == &Ubuntu_Bold12pt8b) { + xOffset = 51; + yOffset = 18; + } + epd->setFont(font); + + // convert & round chart bottom+top label to next range step + chrtMin = commonData->fmt->convertValue(this->chrtMin, dbName, dbFormat, *commonData); + chrtMid = commonData->fmt->convertValue(this->chrtMid, dbName, dbFormat, *commonData); + chrtMax = commonData->fmt->convertValue(this->chrtMax, dbName, dbFormat, *commonData); + chrtMin = std::round(chrtMin * 100.0) / 100.0; + chrtMid = std::round(chrtMid * 100.0) / 100.0; + chrtMax = std::round(chrtMax * 100.0) / 100.0; + + // print top axis label + axLabel = (chrtDataFmt == SPEED || chrtDataFmt == TEMPERATURE) ? chrtMax : chrtMin; + sVal = formatLabel(axLabel); + epd->fillRect(cRoot.x, cRoot.y + 2, xOffset + 3, yOffset, bgColor); // Clear small area to remove potential chart lines + drawTextRalign(cRoot.x + xOffset, cRoot.y + yOffset, sVal); // range value + + // print mid axis label + axLabel = chrtMid; + sVal = formatLabel(axLabel); + epd->fillRect(cRoot.x, cRoot.y + (valAxis / 2) - 8, xOffset + 3, 16, bgColor); // Clear small area to remove potential chart lines + drawTextRalign(cRoot.x + xOffset, cRoot.y + (valAxis / 2) + 6, sVal); // range value + epd->drawLine(cRoot.x + xOffset + 3, cRoot.y + (valAxis / 2), cRoot.x + timAxis, cRoot.y + (valAxis / 2), fgColor); + + // print bottom axis label + axLabel = (chrtDataFmt == SPEED || chrtDataFmt == TEMPERATURE) ? chrtMin : chrtMax; + sVal = formatLabel(axLabel); + epd->fillRect(cRoot.x, cRoot.y + valAxis - 14, xOffset + 3, 15, bgColor); // Clear small area to remove potential chart lines + drawTextRalign(cRoot.x + xOffset, cRoot.y + valAxis, sVal); // range value + epd->drawLine(cRoot.x + xOffset + 3, cRoot.y + valAxis, cRoot.x + timAxis, cRoot.y + valAxis, fgColor); +} + +// print value axis label with multiple axis lines for horizontal chart +void Chart::prntHorizChartMultiValueAxisLabel(const GFXfont* font) +{ + double chrtMin, chrtMax, chrtRng; + double axSlots, axIntv, axLabel; + int xOffset; // offset for text position of x axis label for different font sizes + String sVal; + + if (font == &Ubuntu_Bold10pt8b) { + xOffset = 38; + } else if (font == &Ubuntu_Bold12pt8b) { + xOffset = 50; + } + epd->setFont(font); + + chrtMin = commonData->fmt->convertValue(this->chrtMin, dbName, dbFormat, *commonData); + // chrtMin = std::floor(chrtMin / rngStep) * rngStep; + chrtMin = std::round(chrtMin * 100.0) / 100.0; + chrtMax = commonData->fmt->convertValue(this->chrtMax, dbName, dbFormat, *commonData); + // chrtMax = std::ceil(chrtMax / rngStep) * rngStep; + chrtMax = std::round(chrtMax * 100.0) / 100.0; + chrtRng = std::round((chrtMax - chrtMin) * 100) / 100; + + axSlots = valAxis / static_cast(VALAXIS_STEP); // number of axis labels (and we want to have a double calculation, no integer) + axIntv = chrtRng / axSlots; + axLabel = chrtMin + axIntv; + // LOG_DEBUG(GwLog::DEBUG, "Chart::printHorizMultiValueAxisLabel: chrtRng: %.2f, th-chrtRng: %.2f, axSlots: %.2f, axIntv: %.2f, axLabel: %.2f, chrtMin: %.2f, chrtMid: %.2f, chrtMax: %.2f", chrtRng, this->chrtRng, axSlots, axIntv, axLabel, this->chrtMin, chrtMid, chrtMax); + + int loopStrt, loopEnd, loopStp; + if (chrtDataFmt == SPEED || chrtDataFmt == TEMPERATURE || chrtDataFmt == OTHER) { + // High value at top + loopStrt = valAxis - VALAXIS_STEP; + loopEnd = VALAXIS_STEP / 2; + loopStp = VALAXIS_STEP * -1; + } else { + // Low value at top + loopStrt = VALAXIS_STEP; + loopEnd = valAxis - (VALAXIS_STEP / 2); + loopStp = VALAXIS_STEP; + } + + for (int j = loopStrt; (loopStp > 0) ? (j < loopEnd) : (j > loopEnd); j += loopStp) { + sVal = formatLabel(axLabel); + epd->fillRect(cRoot.x, cRoot.y + j - 11, xOffset + 3, 21, bgColor); // Clear small area to remove potential chart lines + drawTextRalign(cRoot.x + xOffset, cRoot.y + j + 7, sVal); // range value + epd->drawLine(cRoot.x + xOffset + 3, cRoot.y + j, cRoot.x + timAxis, cRoot.y + j, fgColor); + + axLabel += axIntv; + } +} + +// Draw chart line with thickness of 2px +void Chart::drawBoldLine(const int16_t x1, const int16_t y1, const int16_t x2, const int16_t y2) +{ + int16_t dx = std::abs(x2 - x1); + int16_t dy = std::abs(y2 - y1); + + epd->drawLine(x1, y1, x2, y2, fgColor); + + if (dx >= dy) { // line has horizontal tendency + epd->drawLine(x1, y1 - 1, x2, y2 - 1, fgColor); + } else { // line has vertical tendency + epd->drawLine(x1 - 1, y1, x2 - 1, y2, fgColor); + } +} + +// Convert and format current axis label to user defined format; helper function for easier handling of OBP60Formatter +String Chart::convNformatLabel(const double& label) +{ + GwApi::BoatValue tmpBVal(dbName); // temporary boat value for string formatter + String sVal; + + tmpBVal.setFormat(dbFormat); + tmpBVal.valid = true; + tmpBVal.value = label; + sVal = commonData->fmt->formatValue(&tmpBVal, *commonData, NO_SIMUDATA).svalue; // Formatted value as string including unit conversion and switching decimal places + if (sVal.length() > 0 && sVal[0] == '!') { + sVal = sVal.substring(1); // cut leading "!" created at OBPFormatter; doesn't work for other fonts than 7SEG + } + + return sVal; +} + +// Format current axis label for printing w/o data format conversion (has been done earlier) +String Chart::formatLabel(const double& label) +{ + char sVal[11]; + + if (dbFormat == "formatCourse" || dbFormat == "formatWind") { + // Format 3 numbers with prefix zero + snprintf(sVal, sizeof(sVal), "%03.0f", label); + + } else if (dbFormat == "formatRot") { + if (label > -10 && label < 10) { + snprintf(sVal, sizeof(sVal), "%3.2f", label); + } else { + snprintf(sVal, sizeof(sVal), "%3.0f", label); + } + } + + else { + if (label < 10) { + snprintf(sVal, sizeof(sVal), "%3.1f", label); + } else { + snprintf(sVal, sizeof(sVal), "%3.0f", label); + } + } + + return String(sVal); +} +// --- Class Chart --------------- diff --git a/lib/obp60task/OBPcharts.h b/lib/obp60task/OBPcharts.h new file mode 100644 index 0000000..fbdcddd --- /dev/null +++ b/lib/obp60task/OBPcharts.h @@ -0,0 +1,116 @@ +// Function lib for display of boat data in various graphical chart formats +#pragma once +#include "Pagedata.h" +#include "OBP60Extensions.h" + +struct Pos { + int x; + int y; +}; + +struct ChartProps { + double range; + double step; +}; + +template +class RingBuffer; +class GwLog; + +class Chart { +protected: + CommonData* commonData; + GwLog* logger; + + enum ChrtDataFormat { + WIND, + ROTATION, + SPEED, + DEPTH, + TEMPERATURE, + OTHER + }; + + static constexpr char HORIZONTAL = 'H'; + static constexpr char VERTICAL = 'V'; + static constexpr int8_t FULL_SIZE = 0; + static constexpr int8_t HALF_SIZE_LEFT = 1; + static constexpr int8_t HALF_SIZE_RIGHT = 2; + + static constexpr int8_t MIN_FREE_VALUES = 60; // free 60 values when chart line reaches chart end + static constexpr int8_t THRESHOLD_NO_DATA = 3; // max. seconds of invalid values in a row + static constexpr int8_t VALAXIS_STEP = 60; // pixels between two chart value axis labels + + static constexpr bool NO_SIMUDATA = true; // switch off simulation feature of function + + RingBuffer& dataBuf; // Buffer to display + //char chrtDir; // Chart timeline direction: 'H' = horizontal, 'V' = vertical + //int8_t chrtSz; // Chart size: [0] = full size, [1] = half size left/top, [2] half size right/bottom + double dfltRng; // Default range of chart, e.g. 30 = [0..30] + uint16_t fgColor; // color code for any screen writing + uint16_t bgColor; // color code for screen background + bool useSimuData; // flag to indicate if simulation data is active + String tempFormat; // user defined format for temperature + double zeroValue; // "0" SI value for temperature + + int dWidth; // Display width + int dHeight; // Display height + int top = 44; // chart gap at top of display (25 lines for standard gap + 19 lines for axis labels) + int bottom = 25; // chart gap at bottom of display to keep space for status line + int hGap = 11; // gap between 2 horizontal charts; actual gap is 2x + int vGap = 17; // gap between 2 vertical charts; actual gap is 2x + int timAxis, valAxis; // size of time and value chart axis + Pos cRoot; // start point of chart area + double chrtRng; // Range of buffer values from min to max value + double chrtMin; // Range low end value + double chrtMax; // Range high end value + double chrtMid; // Range mid value + double rngStep; // Defines the step of adjustment (e.g. 10 m/s) for value axis range + bool recalcRngMid = false; // Flag for re-calculation of mid value of chart for wind data types + + String dbName, dbFormat; // Name and format of data buffer + ChrtDataFormat chrtDataFmt; // Data format of chart boat data type + double dbMIN_VAL; // Lowest possible value of buffer of type + double dbMAX_VAL; // Highest possible value of buffer of type ; indicates invalid value in buffer + size_t bufSize; // History buffer size: 1.920 values for 32 min. history chart + int count; // current size of buffer + int numBufVals; // number of wind values available for current interval selection + int bufStart; // 1st data value in buffer to show + int numAddedBufVals; // Number of values added to buffer since last display + size_t currIdx; // Current index in TWD history buffer + size_t lastIdx; // Last index of TWD history buffer + size_t lastAddedIdx = 0; // Last index of TWD history buffer when new data was added + int numNoData; // Counter for multiple invalid data values in a row + bool bufDataValid = false; // Flag to indicate if buffer data is valid + int oldChrtIntv = 0; // remember recent user selection of data interval + + double chrtPrevVal; // Last data value in chart area + int x, y; // x and y coordinates for drawing + int prevX, prevY; // Last x and y coordinates for drawing + + bool setChartDimensions(const char direction, const int8_t size); //define dimensions and start points for chart + void drawChrt(const char chrtDir, const int8_t chrtIntv, GwApi::BoatValue& currValue); // Draw chart line + void getBufferStartNSize(const int8_t chrtIntv); // Identify buffer size and buffer start position for chart + void calcChrtBorders(double& rngMin, double& rngMid, double& rngMax, double& rng); // Calculate chart points for value axis and return range between and + void drawChartLines(const char direction, const int8_t chrtIntv, const double chrtScale); // Draw chart graph + Pos setCurrentChartPoint(const int i, const char direction, const double chrtVal, const double chrtScale); // Set current chart point to draw + void drawChrtTimeAxis(const char chrtDir, const int8_t chrtSz, const int8_t chrtIntv); // Draw time axis of chart, value and lines + void drawChrtValAxis(const char chrtDir, const int8_t chrtSz, bool prntLabel); // Draw value axis of chart, value and lines + void prntCurrValue(const char chrtDir, GwApi::BoatValue& currValue); // Add current boat data value to chart + void prntNoValidData(const char chrtDir); // print message for no valid data available + double getAngleRng(const double center, size_t amount); // Calculate range between chart center and edges + void prntVerticChartThreeValueAxisLabel(const GFXfont* font); // print value axis label with only three values: top, mid, and bottom for vertical chart + void prntHorizChartThreeValueAxisLabel(const GFXfont* font); // print value axis label with only three values: top, mid, and bottom for horizontal chart + void prntHorizChartMultiValueAxisLabel(const GFXfont* font); // print value axis label with multiple axis lines for horizontal chart + void drawBoldLine(const int16_t x1, const int16_t y1, const int16_t x2, const int16_t y2); // Draw chart line with thickness of 2px + String convNformatLabel(const double& label); // Convert and format current axis label to user defined format; helper function for easier handling of OBP60Formatter + String formatLabel(const double& label); // Format current axis label for printing w/o data format conversion (has been done earlier) + +public: + // Define default chart range and range step for each boat data type + static std::map dfltChrtDta; + + Chart(RingBuffer& dataBuf, double dfltRng, CommonData& common, bool useSimuData); // Chart object of data chart + ~Chart(); + void showChrt(char chrtDir, int8_t chrtSz, const int8_t chrtIntv, bool prntName, bool showCurrValue, GwApi::BoatValue currValue); // Perform all actions to draw chart +}; diff --git a/lib/obp60task/PageDigitalOut.cpp b/lib/obp60task/PageDigitalOut.cpp new file mode 100644 index 0000000..0dc8f97 --- /dev/null +++ b/lib/obp60task/PageDigitalOut.cpp @@ -0,0 +1,153 @@ +// SPDX-License-Identifier: GPL-2.0-or-later +#if defined BOARD_OBP60S3 || defined BOARD_OBP40S3 + +#include // PCF8574 modules from Horter +#include "Pagedata.h" +#include "OBP60Extensions.h" + +class PageDigitalOut : public Page +{ +private: + // Status values + bool button1 = false; + bool button2 = false; + bool button3 = false; + bool button4 = false; + bool button5 = false; + + // Button labels + String name1; + String name2; + String name3; + String name4; + String name5; + +public: + PageDigitalOut(CommonData &common) : Page(common) + { + logger->logDebug(GwLog::LOG, "Instantiate PageDigitalOut"); + + // Get config data + String lengthformat = config->getString(config->lengthFormat); + name1 = config->getString(config->mod1Out1); + name2 = config->getString(config->mod1Out2); + name3 = config->getString(config->mod1Out3); + name4 = config->getString(config->mod1Out4); + name5 = config->getString(config->mod1Out5); + } + + // Set botton labels + virtual void setupKeys(){ + Page::setupKeys(); + commonData->keydata[0].label = "1"; + commonData->keydata[1].label = "2"; + commonData->keydata[2].label = "3"; + commonData->keydata[3].label = "4"; + commonData->keydata[4].label = "5"; + } + + virtual int handleKey(int key){ + // Code for keylock + if (key == 11) { + commonData->keylock = !commonData->keylock; + return 0; + } + // Code for button 1 + if (key == 1) { + button1 = !button1; + setPCF8574PortPinModul1(0, button1 ? 0 : 1); // Attention! Inverse logic for PCF8574 + return 0; + } + // Code for button 2 + if (key == 2) { + button2 = !button2; + setPCF8574PortPinModul1(1, button2 ? 0 : 1); // Attention! Inverse logic for PCF8574 + return 0; + } + // Code for button 3 + if (key == 3) { + button3 = !button3; + setPCF8574PortPinModul1(2, button3 ? 0 : 1); // Attention! Inverse logic for PCF8574 + return 0; + } + // Code for button 4 + if (key == 4) { + button4 = !button4; + setPCF8574PortPinModul1(3, button4 ? 0 : 1); // Attention! Inverse logic for PCF8574 + return 0; + } + // Code for button 5 + if (key == 5) { + button5 = !button5; + setPCF8574PortPinModul1(4, button5 ? 0 : 1); // Attention! Inverse logic for PCF8574 + return 0; + } + return key; + } + + void displayNew(PageData &pageData) { +#ifdef BOARD_OBP60S3 + // Clear optical warning + if (flashLED == "Limit Violation") { + setBlinkingLED(false); + setFlashLED(false); + } +#endif + }; + + int displayPage(PageData &pageData){ + + // Logging boat values + LOG_DEBUG(GwLog::LOG,"Drawing at PageDigitalOut"); + + // Draw page + //*********************************************************** + + // Set display in partial refresh mode + epd->setPartialWindow(0, 0, epd->width(), epd->height()); // Set partial update + + epd->setTextColor(commonData->fgcolor); + epd->setFont(&Ubuntu_Bold12pt8b); + + // Draw labels + epd->setCursor(100, 50 + 8); + epd->print(name1); + epd->setCursor(100, 100 + 8); + epd->print(name2); + epd->setCursor(100, 150 + 8); + epd->print(name3); + epd->setCursor(100,200 + 8); + epd->print(name4); + epd->setCursor(100, 250 + 8); + epd->print(name5); + + // Draw bottons + drawButtonCenter(50, 50, 40, 27, "1", commonData->fgcolor, commonData->bgcolor, button1); + drawButtonCenter(50, 100, 40, 27, "2", commonData->fgcolor, commonData->bgcolor, button2); + drawButtonCenter(50, 150, 40, 27, "3", commonData->fgcolor, commonData->bgcolor, button3); + drawButtonCenter(50, 200, 40, 27, "4", commonData->fgcolor, commonData->bgcolor, button4); + drawButtonCenter(50, 250, 40, 27, "5", commonData->fgcolor, commonData->bgcolor, button5); + + return PAGE_UPDATE; + }; +}; + +static Page* createPage(CommonData &common){ + return new PageDigitalOut(common); +} + +/** + * with the code below we make this page known to the PageTask + * we give it a type (name) that can be selected in the config + * we define which function is to be called + * and we provide the number of user parameters we expect + * this will be number of BoatValue pointers in pageData.values + */ +PageDescription registerPageDigitalOut( + "DigitalOut", // Page name + createPage, // Action + 0, // Number of bus values depends on selection in Web configuration + true // Show display header on/off +); + +#endif diff --git a/lib/obp60task/PageFourValues2.cpp b/lib/obp60task/PageFourValues2.cpp index c02822e..a4885ba 100644 --- a/lib/obp60task/PageFourValues2.cpp +++ b/lib/obp60task/PageFourValues2.cpp @@ -3,7 +3,6 @@ #include "Pagedata.h" #include "OBP60Extensions.h" -#include "BoatDataCalibration.h" class PageFourValues2 : public Page { @@ -54,9 +53,6 @@ public: GwApi::BoatValue *bvalue1 = pageData.values[0]; // First element in list (only one value by PageOneValue) String name1 = xdrDelete(bvalue1->getName()); // Value name name1 = name1.substring(0, 6); // String length limit for value name -#ifdef ENABLE_CALIBRATION - calibrationData.calibrateInstance(bvalue1, logger); // Check if boat data value is to be calibrated -#endif double value1 = bvalue1->value; // Value as double in SI unit bool valid1 = bvalue1->valid; // Valid information String svalue1 = commonData->fmt->formatValue(bvalue1, *commonData).svalue; // Formatted value as string including unit conversion and switching decimal places @@ -66,9 +62,6 @@ public: GwApi::BoatValue *bvalue2 = pageData.values[1]; // Second element in list (only one value by PageOneValue) String name2 = xdrDelete(bvalue2->getName()); // Value name name2 = name2.substring(0, 6); // String length limit for value name -#ifdef ENABLE_CALIBRATION - calibrationData.calibrateInstance(bvalue2, logger); // Check if boat data value is to be calibrated -#endif double value2 = bvalue2->value; // Value as double in SI unit bool valid2 = bvalue2->valid; // Valid information String svalue2 = commonData->fmt->formatValue(bvalue2, *commonData).svalue; // Formatted value as string including unit conversion and switching decimal places @@ -78,9 +71,6 @@ public: GwApi::BoatValue *bvalue3 = pageData.values[2]; // Second element in list (only one value by PageOneValue) String name3 = xdrDelete(bvalue3->getName()); // Value name name3 = name3.substring(0, 6); // String length limit for value name -#ifdef ENABLE_CALIBRATION - calibrationData.calibrateInstance(bvalue3, logger); // Check if boat data value is to be calibrated -#endif double value3 = bvalue3->value; // Value as double in SI unit bool valid3 = bvalue3->valid; // Valid information String svalue3 = commonData->fmt->formatValue(bvalue3, *commonData).svalue; // Formatted value as string including unit conversion and switching decimal places @@ -90,9 +80,6 @@ public: GwApi::BoatValue *bvalue4 = pageData.values[3]; // Second element in list (only one value by PageOneValue) String name4 = xdrDelete(bvalue4->getName()); // Value name name4 = name4.substring(0, 6); // String length limit for value name -#ifdef ENABLE_CALIBRATION - calibrationData.calibrateInstance(bvalue4, logger); // Check if boat data value is to be calibrated -#endif double value4 = bvalue4->value; // Value as double in SI unit bool valid4 = bvalue4->valid; // Valid information String svalue4 = commonData->fmt->formatValue(bvalue4, *commonData).svalue; // Formatted value as string including unit conversion and switching decimal places diff --git a/lib/obp60task/PageNavigation.cpp b/lib/obp60task/PageNavigation.cpp new file mode 100644 index 0000000..0bcdecd --- /dev/null +++ b/lib/obp60task/PageNavigation.cpp @@ -0,0 +1,607 @@ +#if defined BOARD_OBP60S3 || defined BOARD_OBP40S3 + +#include "Pagedata.h" +#include "OBP60Extensions.h" +#include "NetworkClient.h" // Network connection +#include "ImageDecoder.h" // Image decoder for navigation map +#include + +// Defines for reading of navigation map +#define JSON_BUFFER 30000 // Max buffer size for JSON content (30 kB picture + values) +NetworkClient net(JSON_BUFFER); // Define network client +ImageDecoder decoder; // Define image decoder + +class PageNavigation : public Page +{ +private: + + // Values for buttons + bool firstRun = true; // Detect the first page run + int zoom = 15; // Default zoom level + bool showValues = false; // Show values HDT, SOG, DBT in navigation map + + uint8_t* imageBackupData = nullptr; + int imageBackupWidth = 0; + int imageBackupHeight = 0; + size_t imageBackupSize = 0; + size_t imageBackupCapacity = 0; + bool hasImageBackup = false; + bool imageBackupIsRgb565 = false; + + String lengthformat; + String mapsource; + String ipAddress; + int localPort; + String mapType; + int zoomLevel; + bool grid; + String orientation; + int refreshDistance; + bool showValuesMap; + bool ownHeading; + +public: + PageNavigation(CommonData &common) : Page(common) + { + logger->logDebug(GwLog::LOG,"Instantiate PageNavigation"); + + imageBackupCapacity = (size_t) epd->width() * (size_t) epd->height(); + imageBackupData = (uint8_t*)heap_caps_malloc(imageBackupCapacity, MALLOC_CAP_SPIRAM); + + // Get config data + lengthformat = config->getString(config->lengthFormat); + mapsource = config->getString(config->mapsource); + ipAddress = config->getString(config->ipAddress); + localPort = config->getInt(config->localPort); + mapType = config->getString(config->maptype); + zoomLevel = config->getInt(config->zoomlevel); + grid = config->getBool(config->grid); + orientation = config->getString(config->orientation); + refreshDistance = config->getInt(config->refreshDistance); + showValuesMap = config->getBool(config->showvalues); + ownHeading = config->getBool(config->ownheading); + + } + + // Set botton labels + void setupKeys(){ + Page::setupKeys(); + commonData->keydata[0].label = "ZOOM -"; + commonData->keydata[1].label = "ZOOM +"; + commonData->keydata[4].label = "VALUES"; + } + + int handleKey(int key){ + // Code for keylock + if(key == 11){ + commonData->keylock = !commonData->keylock; + return 0; // Commit the key + } + // Code for zoom - + if(key == 1){ + zoom --; // Zoom - + if(zoom <7){ + zoom = 7; + } + return 0; // Commit the key + } + // Code for zoom - + if(key == 2){ + zoom ++; // Zoom + + if(zoom >17){ + zoom = 17; + } + return 0; // Commit the key + } + if(key == 5){ + showValues = !showValues; // Toggle show values + return 0; // Commit the key + } + return key; + } + + void displayNew(PageData &pageData) { +#ifdef BOARD_OBP60S3 + // Clear optical warning + if (flashLED == "Limit Violation") { + setBlinkingLED(false); + setFlashLED(false); + } +#endif + }; + + int displayPage(PageData &pageData) { + + if (firstRun == true) { + zoom = zoomLevel; // Overwrite zoom level with setup value + showValues = showValuesMap; // Overwrite showValues with setup value + firstRun = false; + } + + // Local variables + String server = "norbert-walter.dnshome.de"; + int port = 80; + int mType = 1; + int dType = 1; + int mapRot = 0; + int symbolRot = 0; + int mapGrid = 0; + + // Old values for hold function + static double value1old = 0; + static String svalue1old = ""; + static String unit1old = ""; + static double value2old = 0; + static String svalue2old = ""; + static String unit2old = ""; + static double value3old = 0; // Deg + static String svalue3old = ""; + static String unit3old = ""; + static double value4old = 0; + static String svalue4old = ""; + static String unit4old = ""; + static double value5old = 0; + static String svalue5old = ""; + static String unit5old = ""; + static double value6old = 0; + static String svalue6old = ""; + static String unit6old = ""; + + static double latitude = 0; + static double latitudeold = 0; + static double longitude = 0; + static double longitudeold = 0; + static double trueHeading = 0; + static double magneticHeading = 0; + static double speedOverGround = 0; + static double depthBelowTransducer = 0; + static int lostCounter = 0; // Counter for connection lost to the map server (increment by each page refresh) + int imgWidth = 0; + int imgHeight = 0; + + // Get boat values #1 Latitude + GwApi::BoatValue *bvalue1 = pageData.values[0]; // First element in list (only one value by PageOneValue) + String name1 = xdrDelete(bvalue1->getName()); // Value name + name1 = name1.substring(0, 6); // String length limit for value name + double value1 = bvalue1->value; // Value as double in SI unit + bool valid1 = bvalue1->valid; // Valid information + String svalue1 = commonData->fmt->formatValue(bvalue1, *commonData).svalue; // Formatted value as string including unit conversion and switching decimal places + String unit1 = commonData->fmt->formatValue(bvalue1, *commonData).unit; // Unit of value + + // Get boat values #2 Longitude + GwApi::BoatValue *bvalue2 = pageData.values[1]; // Second element in list (only one value by PageOneValue) + String name2 = xdrDelete(bvalue2->getName()); // Value name + name2 = name2.substring(0, 6); // String length limit for value name + double value2 = bvalue2->value; // Value as double in SI unit + bool valid2 = bvalue2->valid; // Valid information + String svalue2 = commonData->fmt->formatValue(bvalue2, *commonData).svalue; // Formatted value as string including unit conversion and switching decimal places + String unit2 = commonData->fmt->formatValue(bvalue2, *commonData).unit; // Unit of value + + // Get boat values #3 HDT + GwApi::BoatValue *bvalue3 = pageData.values[2]; // Second element in list (only one value by PageOneValue) + String name3 = xdrDelete(bvalue3->getName()); // Value name + name3 = name3.substring(0, 6); // String length limit for value name + double value3 = bvalue3->value; // Value as double in SI unit + bool valid3 = bvalue3->valid; // Valid information + String svalue3 = commonData->fmt->formatValue(bvalue3, *commonData).svalue; // Formatted value as string including unit conversion and switching decimal places + String unit3 = commonData->fmt->formatValue(bvalue3, *commonData).unit; // Unit of value + + // Get boat values #4 HDM + GwApi::BoatValue *bvalue4 = pageData.values[3]; // Second element in list (only one value by PageOneValue) + String name4 = xdrDelete(bvalue4->getName()); // Value name + name4 = name4.substring(0, 6); // String length limit for value name + double value4 = bvalue4->value; // Value as double in SI unit + bool valid4 = bvalue4->valid; // Valid information + String svalue4 = commonData->fmt->formatValue(bvalue4, *commonData).svalue; // Formatted value as string including unit conversion and switching decimal places + String unit4 = commonData->fmt->formatValue(bvalue4, *commonData).unit; // Unit of value + + // Get boat values #5 SOG + GwApi::BoatValue *bvalue5 = pageData.values[4]; // Second element in list (only one value by PageOneValue) + String name5 = xdrDelete(bvalue5->getName()); // Value name + name5 = name5.substring(0, 6); // String length limit for value name + double value5 = bvalue5->value; // Value as double in SI unit + bool valid5 = bvalue5->valid; // Valid information + String svalue5 = commonData->fmt->formatValue(bvalue5, *commonData).svalue; // Formatted value as string including unit conversion and switching decimal places + String unit5 = commonData->fmt->formatValue(bvalue5, *commonData).unit; // Unit of value + + // Get boat values #6 DBT + GwApi::BoatValue *bvalue6 = pageData.values[5]; // Second element in list (only one value by PageOneValue) + String name6 = xdrDelete(bvalue6->getName()); // Value name + name6 = name6.substring(0, 6); // String length limit for value name + double value6 = bvalue6->value; // Value as double in SI unit + bool valid6 = bvalue6->valid; // Valid information + String svalue6 = commonData->fmt->formatValue(bvalue6, *commonData).svalue; // Formatted value as string including unit conversion and switching decimal places + String unit6 = commonData->fmt->formatValue(bvalue6, *commonData).unit; // Unit of value + + // Logging boat values + if (bvalue1 == NULL) return PAGE_OK; // WTF why this statement? + logger->logDebug(GwLog::LOG, "Drawing at PageNavigation, %s: %f, %s: %f, %s: %f, %s: %f, %s: %f, %s: %f", + name1.c_str(), value1, name2.c_str(), value2, name3.c_str(), value3, + name4.c_str(), value4, name5.c_str(), value5, name6.c_str(), value6); + + // Set variables + //*********************************************************** + + // Latitude + if(valid1){ + latitude = value1; + latitudeold = value1; + value3old = value1; + } + else{ + latitude = value1old; + } + // Longitude + if(valid2){ + longitude = value2; + longitudeold = value2; + value2old = value2; + } + else{ + longitude = value2old; + } + // HDT value (True Heading, GPS) + if(valid3){ + trueHeading = (value3 * 360) / (2 * PI); + value3old = trueHeading; + } + else{ + trueHeading = value3old; + } + // HDM value (Magnetic Heading) + if(valid4){ + magneticHeading = (value4 * 360) / (2 * PI); + value4old = magneticHeading; + } + else{ + speedOverGround = value4old; + } + // SOG value (Speed Over Ground) + if(valid5){ + speedOverGround = value5; + value5old = value5; + } + else{ + speedOverGround = value5old; + } + // DBT value (Depth Below Transducer) + if(valid6){ + depthBelowTransducer = value6; + value6old = value6; + } + else{ + depthBelowTransducer = value6old; + } + + // Prepare config values for URL + //*********************************************************** + + // Server settings + if(mapsource == "OBP Service"){ + server = "norbert-walter.dnshome.de"; + port = 80; + } + else if(mapsource == "Local Service"){ + server = String(ipAddress); + port = localPort; + } + else{ + server = "norbert-walter.dnshome.de"; + port = 80; + } + + // Type of navigation map + if(mapType == "Open Street Map"){ + mType = 1; // Map type + dType = 1; // Dithering type + } + else if(mapType == "Google Street"){ + mType = 3; + dType = 2; + } + else if(mapType == "Open Topo Map"){ + mType = 5; + dType = 2; + } + else if(mapType == "Stadimaps Toner"){ + mType = 7; + dType = 1; + } + else if(mapType == "Free Nautical Chart"){ + mType = 9; + dType = 1; + } + else if(mapType == "C-Map"){ + mType = 103486987; + dType = 1; + } + else if(mapType == "Garmin Fish"){ + mType = 113486987; + dType = 1; + } + else if(mapType == "Garmin Nav"){ + mType = 123486987; + dType = 1; + } + else{ + mType = 1; + dType = 1; + } + + // Map grid on/off + if(grid == true){ + mapGrid = 1; + } + else{ + mapGrid = 0; + } + + // Map orientation + if(orientation == "North Direction"){ + mapRot = 0; + // If true heading available then use HDT oterwise HDM + if(valid3 == true){ + symbolRot = trueHeading; + } + else{ + symbolRot = magneticHeading; + } + } + else if(orientation == "Travel Direction"){ + // If true heading available then use HDT oterwise HDM + if(valid3 == true){ + mapRot = trueHeading; + symbolRot = trueHeading; + } + else{ + mapRot = magneticHeading; + symbolRot = magneticHeading; + } + } + else{ + mapRot = 0; + // If true heading available then use HDT oterwise HDM + if(valid3 == true){ + symbolRot = trueHeading; + } + else{ + symbolRot = magneticHeading; + } + } + + // Load navigation map + //*********************************************************** + + // URL to OBP Maps Converter + // For more details see: https://github.com/norbert-walter/maps-converter + String url = String("http://") + server + ":" + port + // OBP Server + String("/get_image_json?") + // Service: Output B&W picture as JSON (Base64 + gzip) + #ifdef DISPLAY_ST7796 + "oformat=3" + // Image output format in JSON: 3=RGB565 format + #else + "oformat=4" + // Image output format in JSON: 4=b/w 1-Bit format + #endif + "&zoom=" + zoom + // Default zoom level: 15 + "&lat=" + String(latitude, 6) + // Latitude + "&lon=" + String(longitude, 6) + // Longitude + "&mrot=" + mapRot + // Rotation angle navigation map in degree + "&mtype=" + mType + // Default Map: Open Street Map + #ifdef DISPLAY_ST7796 + "&itype=1" + // Image type: 1=Color + #else + "&itype=4" + // Image type: 4=b/w with dithering + #endif + "&dtype=" + dType + // Dithering type: Atkinson dithering (only activ when itype=4 otherwise inactive) + "&width=400" + // With navigation map + "&height=250" + // Height navigation map + "&cutout=0" + // No picture cutouts (tab, border and alpha are unused when cutout=0) + "&tab=0" + // No tab size (only available when sqare cutouts selected coutout=3...7) + "&border=2" + // Border line size: 2 pixel (only available when sqare cutouts selected) + "&alpha=80" + // Alpha for tabs: 80% visible (only available when sqare cutouts selected) + "&symbol=2" + // Symbol: Triangle + "&srot=" + symbolRot + // Symbol rotation angle + "&ssize=15" + // Symbole size: 15 pixel (center pointer) + "&grid=" + mapGrid // Show grid: On + ; + + // Draw page + //*********************************************************** + + // ############### Draw Navigation Map ################ + + // Set display in partial refresh mode + epd->setPartialWindow(0, 0, epd->width(), epd->height()); // Set partial update + epd->setTextColor(commonData->fgcolor); + + // NEW: simple exponential backoff for 1 Hz polling (prevents connection-refused storms) + static uint32_t nextAllowedMs = 0; + static uint8_t failCount = 0; + + uint32_t now = millis(); + + // NEW: if we are in backoff window, skip network call and use backup immediately + bool allowFetch = ((int32_t)(now - nextAllowedMs) >= 0); + + // If a network connection to URL then load the navigation map + if (allowFetch && net.fetchAndDecompressJson(url)) { + + // NEW: reset backoff on success + failCount = 0; + nextAllowedMs = now + 1000; // keep 1 Hz on success + + int numPix = net.numberPixels(); // Read number of pixels + imgWidth = net.imageWidth(); // Read width of image + imgHeight = net.imageHeight(); // Read height of image + size_t requiredBytesMono = 0; + size_t requiredBytesRgb565 = 0; + if (imgWidth > 0 && imgHeight > 0){ + requiredBytesMono = (size_t)((imgWidth + 7) / 8) * (size_t)imgHeight; + requiredBytesRgb565 = (size_t)imgWidth * (size_t)imgHeight * 2U; + } + if (requiredBytesMono == 0){ + logger->logDebug(GwLog::ERROR,"Error PageNavigation: invalid image geometry w=%d h=%d",imgWidth,imgHeight); + return PAGE_UPDATE; + } + + const char* b64src = net.pictureBase64(); // Read picture as Base64 content + if (b64src == nullptr){ + logger->logDebug(GwLog::ERROR,"Error PageNavigation: picture_base64 missing"); + return PAGE_UPDATE; + } + size_t b64len = net.pictureBase64Len(); // Calculate length of Base64 content + // Copy Base64 content in PSRAM + char* b64 = (char*) heap_caps_malloc(b64len + 1, MALLOC_CAP_SPIRAM); // Allcate PSRAM for Base64 content + if (!b64) { + logger->logDebug(GwLog::ERROR,"Error PageNavigation: PSRAM alloc base64 failed"); + return PAGE_UPDATE; + } + memcpy(b64, b64src, b64len + 1); // Copy Base64 content in PSRAM + + // Set image buffer in PSRAM + size_t imgSize = (numPix > 0) ? (size_t)numPix : requiredBytesMono; // Calculate image size + if (imgSize < requiredBytesMono){ + imgSize = requiredBytesMono; + } + uint8_t* imageData = (uint8_t*) heap_caps_malloc(imgSize, MALLOC_CAP_SPIRAM); // Allocate PSRAM for image + if (!imageData) { + logger->logDebug(GwLog::ERROR,"Error PageNavigation: PSRAM alloc image buffer failed"); + free(b64); + return PAGE_UPDATE; + } + + // Decode Base64 content to image + size_t decodedSize = 0; + bool decodeOk = decoder.decodeBase64(b64, b64len, imageData, imgSize, decodedSize); + if (!decodeOk || decodedSize < requiredBytesMono){ + int base64Ret = mbedtls_base64_decode( + nullptr, + 0, + &decodedSize, + (const unsigned char*)b64, + b64len + ); + logger->logDebug(GwLog::ERROR, + "Error PageNavigation: decode failed (ok=%d, decoded=%u, required=%u, b64ret=%d)", + decodeOk ? 1 : 0, + (unsigned int)decodedSize, + (unsigned int)requiredBytesMono, + base64Ret + ); + free(b64); + free(imageData); + return PAGE_UPDATE; + } + + // Copy actual navigation map to backup map + imageBackupWidth = imgWidth; + imageBackupHeight = imgHeight; + imageBackupSize = imgSize; + if (decodedSize > 0 && imageBackupData != nullptr) { + size_t copySize = (decodedSize > imageBackupCapacity) ? imageBackupCapacity : decodedSize; + memcpy(imageBackupData, imageData, copySize); + imageBackupSize = copySize; + } + hasImageBackup = (imageBackupData != nullptr); + lostCounter = 0; + + // Show image (navigation map) + epd->drawBitmap(0, 25, imageData, imgWidth, imgHeight, commonData->fgcolor); + + // Clean PSRAM + free(b64); + free(imageData); + } + // If no network connection then use backup navigation map + else { + + // NEW: update backoff only if we actually attempted a fetch (not when skipping due to backoff) + if (allowFetch) { + // NEW: exponential backoff: 1s,2s,4s,8s,16s,30s (capped) + if (failCount < 6) failCount++; + uint32_t backoffMs = 1000u << failCount; + if (backoffMs > 30000u) backoffMs = 30000u; + nextAllowedMs = now + backoffMs; + } else { + // NEW: we are currently backing off; do not increase failCount further + // nextAllowedMs stays unchanged + } + + // Show backup image (backup navigation map) + if (hasImageBackup) { + epd->drawBitmap(0, 25, imageBackupData, imageBackupWidth, imageBackupHeight, commonData->fgcolor); + } + + // Show connection lost info when 5 page refreshes has a connection lost to the map server + // Short connection losts are uncritical + if(lostCounter >= 5){ + epd->setFont(&Ubuntu_Bold12pt8b); + epd->fillRect(200, 250 , 200, 25, commonData->fgcolor); + epd->fillRect(202, 252 , 196, 21, commonData->bgcolor); + epd->setCursor(210, 270); + epd->print("Map server lost"); + } + + lostCounter++; + } + + // ############### Draw Values ################ + epd->setFont(&Ubuntu_Bold12pt8b); + + // Show zoom level + epd->fillRect(355, 25 , 45, 25, commonData->fgcolor); + epd->fillRect(357, 27 , 41, 21, commonData->bgcolor); + epd->setCursor(364, 45); + epd->print(zoom); + // If true heading available then use HDT oterwise HDM + if (showValues == true) { + // Frame + epd->fillRect(0, 25 , 130, 65, commonData->fgcolor); + epd->fillRect(2, 27 , 126, 61, commonData->bgcolor); + if(valid3 == true){ + // HDT + epd->setCursor(10, 45); + epd->print(name3); + epd->setCursor(70, 45); + epd->print(svalue3); + } + else{ + // HDM + epd->setCursor(10, 45); + epd->print(name4); + epd->setCursor(70, 45); + epd->print(svalue4); + } + // SOG + epd->setCursor(10, 65); + epd->print(name5); + epd->setCursor(70, 65); + epd->print(svalue5); + // DBT + epd->setCursor(10, 85); + epd->print(name6); + epd->setCursor(70, 85); + epd->print(svalue6); + } + + return PAGE_UPDATE; + }; +}; + +static Page *createPage(CommonData &common){ + return new PageNavigation(common); +}/** + * with the code below we make this page known to the PageTask + * we give it a type (name) that can be selected in the config + * we define which function is to be called + * and we provide the number of user parameters we expect + * this will be number of BoatValue pointers in pageData.values + */ +PageDescription registerPageNavigation( + "Navigation", // Page name + createPage, // Action + 0, // Number of bus values depends on selection in Web configuration + {"LAT","LON","HDT","HDM","SOG","DBT"}, // Bus values we need in the page + true // Show display header on/off +); + +#endif diff --git a/lib/obp60task/PageSystem.cpp b/lib/obp60task/PageSystem.cpp index e9eb5ca..20772d8 100644 --- a/lib/obp60task/PageSystem.cpp +++ b/lib/obp60task/PageSystem.cpp @@ -30,6 +30,7 @@ #include #include "qrcode.h" #include "Nmea2kTwai.h" +#include #ifdef BOARD_OBP40S3 #include "dirent.h" @@ -58,6 +59,7 @@ private: String buzzer_mode; uint8_t buzzer_power; String cpuspeed; + String powermode; String rtc_module; String gps_module; String env_module; @@ -80,6 +82,15 @@ private: ConfigMenu *menu; + struct device { + uint64_t NAME; + uint8_t id; + char hex_name[17]; + uint16_t manuf_code; + const char *model; + }; + std::vector devicelist; + void incMode() { if (mode == 'N') { // Normal mode = 'S'; @@ -102,9 +113,9 @@ private: void decMode() { if (mode == 'N') { if (hasSDCard) { - mode = 'A'; + mode = 'A'; // SD-Card } else { - mode = 'D'; + mode = 'D'; // Device list } } else if (mode == 'S') { // Settings mode = 'N'; @@ -344,6 +355,11 @@ private: epd->setCursor(x0, y0 + 144); epd->print("Home Lon.:"); drawTextRalign(230, y0 + 144, formatLongitude(homelon)); + // Power + epd->setCursor(x0, y0 + 176); + epd->print("Power mode:"); + epd->setCursor(120, y0 + 176); + epd->print(powermode); // right column epd->setCursor(202, y0); @@ -362,6 +378,15 @@ private: epd->print("Gen. sensor:"); epd->setCursor(320, y0 + 32); epd->print(gen_sensor); + // TODO + // Gyro sensor (rotation) + epd->setCursor(202, y0 + 48); + epd->print("Rot. sensor:"); + epd->setCursor(320, y0 + 48); + epd->print(rot_sensor); + + // Temp.-sensor + // Power Mode #ifdef BOARD_OBP60S3 // Backlight infos @@ -532,6 +557,42 @@ private: epd->setCursor(20, 140); epd->printf("N2k source address: %d", NMEA2000->GetN2kSource()); + uint16_t x0 = 20; + uint16_t y0 = 100; + + epd->setFont(&Ubuntu_Bold10pt8b); + epd->setCursor(x0, y0); + epd->print("ID"); + epd->setCursor(x0 + 50, y0); + epd->print("Model"); + epd->setCursor(x0 + 250, y0); + epd->print("Manuf."); + epd->drawLine(18, y0 + 4, 360 , y0 + 4 , commonData->fgcolor); + + epd->setFont(&Ubuntu_Bold8pt8b); + y0 = 120; + uint8_t n_dev = 0; + for (const device& item : devicelist) { + if (n_dev > 8) { + break; + } + epd->setCursor(x0, y0 + n_dev * 20); + epd->print(item.id); + epd->setCursor(x0 + 50, y0 + n_dev * 20); + epd->print(item.model); + epd->setCursor(x0 + 250, y0 + n_dev * 20); + epd->print(item.manuf_code); + n_dev++; + } + epd->setCursor(x0, y0 + (n_dev + 1) * 20); + if (n_dev == 0) { + epd->printf("no devices found on bus"); + + } else { + epd->drawLine(18, y0 + n_dev * 20, 360 , y0 + n_dev * 20, commonData->fgcolor); + epd->printf("%d devices of %d in total", n_dev, devicelist.size()); + } + } void storeConfig() { @@ -556,6 +617,7 @@ public: buzzer_mode.toLowerCase(); buzzer_power = config->getInt(config->buzzerPower); cpuspeed = config->getString(config->cpuSpeed); + powermode = config->getString(config->powerMode); env_module = config->getString(config->useEnvSensor); rtc_module = config->getString(config->useRTC); gps_module = config->getString(config->useGPS); @@ -681,6 +743,28 @@ public: // Get references from API logger->logDebug(GwLog::LOG, "New page display: PageSystem"); NMEA2000 = pageData.api->getNMEA2000(); + + // load current device list + tN2kDeviceList *pDevList = pageData.api->getN2kDeviceList(); + // TODO check if changed + if (pDevList->ReadResetIsListUpdated()) { + // only reload if changed + devicelist.clear(); + for (uint8_t i = 0; i <= 252; i++) { + const tNMEA2000::tDevice *d = pDevList->FindDeviceBySource(i); + if (d == nullptr) { + continue; + } + device dev; + dev.id = i; + dev.NAME = d->GetName(); + snprintf(dev.hex_name, sizeof(dev.hex_name), "%08X%08X", (uint32_t)(dev.NAME >> 32), (uint32_t)(dev.NAME & 0xFFFFFFFF)); + dev.manuf_code = d->GetManufacturerCode(); + dev.model = d->GetModelID(); + devicelist.push_back(dev); + } + } + }; int displayPage(PageData &pageData) { diff --git a/lib/obp60task/PageWindPlot.cpp b/lib/obp60task/PageWindPlot.cpp index 38b4182..dbd7636 100644 --- a/lib/obp60task/PageWindPlot.cpp +++ b/lib/obp60task/PageWindPlot.cpp @@ -1,127 +1,113 @@ -// SPDX-License-Identifier: GPL-2.0-or-later #if defined BOARD_OBP60S3 || defined BOARD_OBP40S3 #include "Pagedata.h" #include "OBP60Extensions.h" -#include "OBPRingBuffer.h" #include "OBPDataOperations.h" -#include "BoatDataCalibration.h" -#include - -static const double radToDeg = 180.0 / M_PI; // Conversion factor from radians to degrees - -// Get maximum difference of last of TWD ringbuffer values to center chart; returns "0" if data is not valid -int getCntr(const RingBuffer& windDirHstry, size_t amount) -{ - const int MAX_VAL = windDirHstry.getMaxVal(); - size_t count = windDirHstry.getCurrentSize(); - - if (windDirHstry.isEmpty() || amount <= 0) { - return 0; - } - if (amount > count) - amount = count; - - uint16_t midWndDir, minWndDir, maxWndDir = 0; - int wndCenter = 0; - - midWndDir = windDirHstry.getMid(amount); - if (midWndDir != MAX_VAL) { - midWndDir = midWndDir / 1000.0 * radToDeg; - wndCenter = int((midWndDir + (midWndDir >= 0 ? 5 : -5)) / 10) * 10; // Set new center value; round to nearest 10 degree value - minWndDir = windDirHstry.getMin(amount) / 1000.0 * radToDeg; - maxWndDir = windDirHstry.getMax(amount) / 1000.0 * radToDeg; - if ((maxWndDir - minWndDir) > 180 && !(minWndDir > maxWndDir)) { // if wind range is > 180 and no 0° crossover, adjust wndCenter to smaller wind range end - wndCenter = WindUtils::to360(wndCenter + 180); - } - } - - return wndCenter; -} - -// Get maximum difference of last of TWD ringbuffer values to center chart -int getRng(const RingBuffer& windDirHstry, int center, size_t amount) -{ - int minVal = windDirHstry.getMinVal(); - const int MAX_VAL = windDirHstry.getMaxVal(); - size_t count = windDirHstry.getCurrentSize(); - - if (windDirHstry.isEmpty() || amount <= 0) { - return MAX_VAL; - } - if (amount > count) - amount = count; - - int value = 0; - int rng = 0; - int maxRng = minVal; - // Start from the newest value (last) and go backwards x times - for (size_t i = 0; i < amount; i++) { - value = windDirHstry.get(count - 1 - i); - - if (value == MAX_VAL) { - continue; // ignore invalid values - } - - value = value / 1000.0 * radToDeg; - rng = abs(((value - center + 540) % 360) - 180); - if (rng > maxRng) - maxRng = rng; - } - if (maxRng > 180) { - maxRng = 180; - } - - return (maxRng != minVal ? maxRng : MAX_VAL); -} +#include "OBPcharts.h" // **************************************************************** -class PageWindPlot : public Page { +class PageWindPlot : public Page +{ + private: + GwLog* logger; + + enum ChartMode { + DIRECTION, + SPEED, + BOTH + }; + + static constexpr char HORIZONTAL = 'H'; + static constexpr char VERTICAL = 'V'; + static constexpr int8_t FULL_SIZE = 0; + static constexpr int8_t HALF_SIZE_LEFT = 1; + static constexpr int8_t HALF_SIZE_RIGHT = 2; + + static constexpr bool PRNT_NAME = true; + static constexpr bool NO_PRNT_NAME = false; + static constexpr bool PRNT_VALUE = true; + static constexpr bool NO_PRNT_VALUE = false; + + // int width; // Screen width + // int height; // Screen height + bool keylock = false; // Keylock - char chrtMode = 'D'; // Chart mode: 'D' for TWD, 'S' for TWS, 'B' for both - bool showTruW = true; // Show true wind or apparant wind in chart area + ChartMode chrtMode = DIRECTION; + bool showTruW = true; // Show true wind or apparent wind in chart area bool oldShowTruW = false; // remember recent user selection of wind data type - int dataIntv = 1; // Update interval for wind history chart: - // (1)|(2)|(3)|(4) seconds for approx. 4, 8, 12, 16 min. history chart + int8_t dataIntv = 1; // Update interval for wind history chart: + // (1)|(2)|(3)|(4)|(8) x 240 seconds for 4, 8, 12, 16, 32 min. history chart + bool useSimuData; + // bool holdValues; + String flashLED; + String backlightMode; + +#ifdef BOARD_OBP40S3 + String wndSrc; // Wind source true/apparent wind - preselection for OBP40 +#endif + + // Data buffers pointers (owned by HstryBuffers) + RingBuffer* twdHstry = nullptr; + RingBuffer* twsHstry = nullptr; + RingBuffer* awdHstry = nullptr; + RingBuffer* awsHstry = nullptr; + + // Chart objects + std::unique_ptr twdChart, awdChart; // Chart object for wind direction + std::unique_ptr twsChart, awsChart; // Chart object for wind speed + + // Active charts and values + Chart* wdChart = nullptr; + Chart* wsChart = nullptr; + GwApi::BoatValue* wdBVal = nullptr; + GwApi::BoatValue* wsBVal = nullptr; public: PageWindPlot(CommonData& common) : Page(common) { logger->logDebug(GwLog::LOG, "Instantiate PageWindPlot"); + + //width = epd->width(); // Screen width + //height = epd->height(); // Screen height + + // Get config data + oldShowTruW = !showTruW; // makes wind source being initialized at initial page call } - void setupKeys() { + void setupKeys() + { Page::setupKeys(); - // commonData->keydata[0].label = "MODE"; + commonData->keydata[0].label = "MODE"; #if defined BOARD_OBP60S3 commonData->keydata[1].label = "SRC"; - commonData->keydata[4].label = "INTV"; + commonData->keydata[4].label = "ZOOM"; #elif defined BOARD_OBP40S3 - commonData->keydata[1].label = "INTV"; + commonData->keydata[1].label = "ZOOM"; #endif } // Key functions - int handleKey(int key) { - // Set chart mode TWD | TWS -> to be implemented + int handleKey(int key) + { + // Set chart mode if (key == 1) { - if (chrtMode == 'D') { - chrtMode = 'S'; - } else if (chrtMode == 'S') { - chrtMode = 'B'; + if (chrtMode == DIRECTION) { + chrtMode = SPEED; + } else if (chrtMode == SPEED) { + chrtMode = BOTH; } else { - chrtMode = 'D'; + chrtMode = DIRECTION; } - return 0; // Commit the key + return 0; } #if defined BOARD_OBP60S3 // Set data source TRUE | APP if (key == 2) { showTruW = !showTruW; - return 0; // Commit the key + return 0; } // Set interval for wind history chart update time (interval) @@ -135,10 +121,12 @@ public: dataIntv = 3; } else if (dataIntv == 3) { dataIntv = 4; + } else if (dataIntv == 4) { + dataIntv = 8; } else { dataIntv = 1; } - return 0; // Commit the key + return 0; } // Keylock function @@ -149,7 +137,8 @@ public: return key; } - void displayNew(PageData &pageData) { + virtual void displayNew(PageData& pageData) + { #ifdef BOARD_OBP60S3 // Clear optical warning if (flashLED == "Limit Violation") { @@ -158,344 +147,99 @@ public: } #endif #ifdef BOARD_OBP40S3 - String wndSrc; // Wind source true/apparant wind - preselection for OBP40 - + // we can only initialize user defined wind source here, because "pageData" is not available at object instantiation wndSrc = commonData->config->getString("page" + String(pageData.pageNumber) + "wndsrc"); - if (wndSrc =="True wind") { + if (wndSrc == "True wind") { showTruW = true; } else { - showTruW = false; // Wind source is apparant wind + showTruW = false; // Wind source is apparent wind } - commonData->logger->logDebug(GwLog::LOG,"New PageWindPlot: wind source=%s", wndSrc); + oldShowTruW = !showTruW; // Force chart update in displayPage #endif - oldShowTruW = !showTruW; // makes wind source being initialized at initial page call + + if (!twdChart) { // Create true wind charts if they don't exist + twdHstry = pageData.hstryBuffers->getBuffer("TWD"); + twsHstry = pageData.hstryBuffers->getBuffer("TWS"); + + if (twdHstry) { + twdChart.reset(new Chart(*twdHstry, Chart::dfltChrtDta["formatCourse"].range, *commonData, useSimuData)); + } + if (twsHstry) { + twsChart.reset(new Chart(*twsHstry, Chart::dfltChrtDta["formatKnots"].range, *commonData, useSimuData)); + } + } + + if (!awdChart) { // Create apparent wind charts if they don't exist + awdHstry = pageData.hstryBuffers->getBuffer("AWD"); + awsHstry = pageData.hstryBuffers->getBuffer("AWS"); + + if (awdHstry) { + awdChart.reset(new Chart(*awdHstry, Chart::dfltChrtDta["formatCourse"].range, *commonData, useSimuData)); + } + if (awsHstry) { + awsChart.reset(new Chart(*awsHstry, Chart::dfltChrtDta["formatKnots"].range, *commonData, useSimuData)); + } + if (twdHstry && twsHstry && awdHstry && awsHstry) { + LOG_DEBUG(GwLog::DEBUG, "PageWindPlot: Created wind charts"); + } else { + LOG_DEBUG(GwLog::DEBUG, "PageWindPlot: Some/all chart objects for wind data missing"); + } + } } - int displayPage(PageData& pageData) { - - static RingBuffer* wdHstry; // Wind direction data buffer - static RingBuffer* wsHstry; // Wind speed data buffer - static String wdName, wdFormat; // Wind direction name and format - static String wsName, wsFormat; // Wind speed name and format - static int16_t wdMAX_VAL; // Max. value of wd history buffer, indicating invalid values - float wsValue; // Wind speed value in chart area - String wsUnit; // Wind speed unit in chart area - static GwApi::BoatValue* wsBVal = new GwApi::BoatValue("TWS"); // temp BoatValue for wind speed unit identification; required by OBP60Formater - - // current boat data values; TWD/AWD only for validation test - const int numBoatData = 2; - GwApi::BoatValue* bvalue; - bool BDataValid[numBoatData]; - - static bool isInitialized = false; // Flag to indicate that page is initialized - static bool wndDataValid = false; // Flag to indicate if wind data is valid - static int numNoData; // Counter for multiple invalid data values in a row - - static int width; // Screen width - static int height; // Screen height - static int xCenter; // Center of screen in x direction - static const int yOffset = 48; // Offset for y coordinates of chart area - static int cHeight; // height of chart area - static int bufSize; // History buffer size: 960 values for appox. 16 min. history chart - static int intvBufSize; // Buffer size used for currently selected time interval - int count; // current size of buffer - static int numWndVals; // number of wind values available for current interval selection - static int bufStart; // 1st data value in buffer to show - int numAddedBufVals; // Number of values added to buffer since last display - size_t currIdx; // Current index in TWD history buffer - static size_t lastIdx; // Last index of TWD history buffer - static size_t lastAddedIdx = 0; // Last index of TWD history buffer when new data was added - static int oldDataIntv; // remember recent user selection of data interval - - static int wndCenter; // chart wind center value position - static int wndLeft; // chart wind left value position - static int wndRight; // chart wind right value position - static int chrtRng; // Range of wind values from mid wind value to min/max wind value in degrees - int diffRng; // Difference between mid and current wind value - static const int dfltRng = 60; // Default range for chart - int midWndDir; // New value for wndCenter after chart start / shift - - int x, y; // x and y coordinates for drawing - static int prevX, prevY; // Last x and y coordinates for drawing - static float chrtScl; // Scale for wind values in pixels per degree - int chrtVal; // Current wind value - static int chrtPrevVal; // Last wind value in chart area for check if value crosses 180 degree line - + int displayPage(PageData& pageData) + { logger->logDebug(GwLog::LOG, "Display PageWindPlot"); - ulong timer = millis(); - - if (!isInitialized) { - width = epd->width(); - height = epd->height(); - xCenter = width / 2; - cHeight = height - yOffset - 22; - numNoData = 0; - bufStart = 0; - oldDataIntv = 0; - wsValue = 0; - numAddedBufVals, currIdx, lastIdx = 0; - wndCenter = INT_MAX; - midWndDir = 0; - diffRng = dfltRng; - chrtRng = dfltRng; - - isInitialized = true; // Set flag to indicate that page is now initialized - } - - // read boat data values; TWD only for validation test, TWS for display of current value - for (int i = 0; i < numBoatData; i++) { - bvalue = pageData.values[i]; - BDataValid[i] = bvalue->valid; - } - - // Optical warning by limit violation (unused) - if (String(flashLED) == "Limit Violation") { - setBlinkingLED(false); - setFlashLED(false); - } + // ulong pageTime = millis(); if (showTruW != oldShowTruW) { + + // Switch active charts based on showTruW if (showTruW) { - wdHstry = pageData.boatHstry->hstryBufList.twdHstry; - wsHstry = pageData.boatHstry->hstryBufList.twsHstry; + wdChart = twdChart.get(); + wsChart = twsChart.get(); + wdBVal = pageData.values[0]; + wsBVal = pageData.values[1]; } else { - wdHstry = pageData.boatHstry->hstryBufList.awdHstry; - wsHstry = pageData.boatHstry->hstryBufList.awsHstry; + wdChart = awdChart.get(); + wsChart = awsChart.get(); + wdBVal = pageData.values[2]; + wsBVal = pageData.values[3]; } - wdHstry->getMetaData(wdName, wdFormat); - wsHstry->getMetaData(wsName, wsFormat); - wdMAX_VAL = wdHstry->getMaxVal(); - bufSize = wdHstry->getCapacity(); - wsBVal->setFormat(wsHstry->getFormat()); - lastAddedIdx = wdHstry->getLastIdx(); oldShowTruW = showTruW; } - - // Identify buffer size and buffer start position for chart - count = wdHstry->getCurrentSize(); - currIdx = wdHstry->getLastIdx(); - numAddedBufVals = (currIdx - lastAddedIdx + bufSize) % bufSize; // Number of values added to buffer since last display - if (dataIntv != oldDataIntv || count == 1) { - // new data interval selected by user - intvBufSize = cHeight * dataIntv; - numWndVals = min(count, (cHeight - 60) * dataIntv); - bufStart = max(0, count - numWndVals); - lastAddedIdx = currIdx; - oldDataIntv = dataIntv; - } else { - numWndVals = numWndVals + numAddedBufVals; - lastAddedIdx = currIdx; - if (count == bufSize) { - bufStart = max(0, bufStart - numAddedBufVals); - } - } - logger->logDebug(GwLog::DEBUG, "PageWindPlot Dataset: count: %d, xWD: %.1f, xWS: %.2f, xWD_valid? %d, intvBufSize: %d, numWndVals: %d, bufStart: %d, numAddedBufVals: %d, lastIdx: %d, wind source: %s", - count, wdHstry->getLast() / 1000.0 * radToDeg, wsHstry->getLast() / 1000.0 * 1.94384, BDataValid[0], intvBufSize, numWndVals, bufStart, numAddedBufVals, wdHstry->getLastIdx(), - showTruW ? "True" : "App"); - - // Set wndCenter from 1st real buffer value - if (wndCenter == INT_MAX || (wndCenter == 0 && count == 1)) { - wndCenter = getCntr(*wdHstry, numWndVals); - logger->logDebug(GwLog::DEBUG, "PageWindPlot Range Init: count: %d, xWD: %.1f, wndCenter: %d, diffRng: %d, chrtRng: %d, Min: %.0f, Max: %.0f", count, wdHstry->getLast() / 1000.0 * radToDeg, - wndCenter, diffRng, chrtRng, wdHstry->getMin(numWndVals) / 1000.0 * radToDeg, wdHstry->getMax(numWndVals) / 1000.0 * radToDeg); - } else { - // check and adjust range between left, center, and right chart limit - diffRng = getRng(*wdHstry, wndCenter, numWndVals); - diffRng = (diffRng == wdMAX_VAL ? 0 : diffRng); - if (diffRng > chrtRng) { - chrtRng = int((diffRng + (diffRng >= 0 ? 9 : -1)) / 10) * 10; // Round up to next 10 degree value - } else if (diffRng + 10 < chrtRng) { // Reduce chart range for higher resolution if possible - chrtRng = max(dfltRng, int((diffRng + (diffRng >= 0 ? 9 : -1)) / 10) * 10); - logger->logDebug(GwLog::DEBUG, "PageWindPlot Range adjust: wndCenter: %d, diffRng: %d, chrtRng: %d, Min: %.0f, Max: %.0f", wndCenter, diffRng, chrtRng, - wdHstry->getMin(numWndVals) / 1000.0 * radToDeg, wdHstry->getMax(numWndVals) / 1000.0 * radToDeg); - } - } - chrtScl = float(width) / float(chrtRng) / 2.0; // Chart scale: pixels per degree - wndLeft = wndCenter - chrtRng; - if (wndLeft < 0) - wndLeft += 360; - wndRight = (chrtRng < 180 ? wndCenter + chrtRng : wndCenter + chrtRng - 1); - if (wndRight >= 360) - wndRight -= 360; + logger->logDebug(GwLog::DEBUG, "PageWindPlot: draw with data %s: %.2f, %s: %.2f", wdBVal->getName().c_str(), wdBVal->value, wsBVal->getName().c_str(), wsBVal->value); // Draw page - //*********************************************************************** + //*********************************************************** // Set display in partial refresh mode - epd->setPartialWindow(0, 0, width, height); // Set partial update + epd->setPartialWindow(0, 0, epd->width(), epd->height()); epd->setTextColor(commonData->fgcolor); - // chart lines - epd->fillRect(0, yOffset, width, 2, commonData->fgcolor); - epd->fillRect(xCenter, yOffset, 1, cHeight, commonData->fgcolor); - - // chart labels - char sWndLbl[4]; // char buffer for Wind angle label - epd->setFont(&Ubuntu_Bold12pt8b); - epd->setCursor(xCenter - 88, yOffset - 3); - epd->print(wdName); // Wind data name - snprintf(sWndLbl, 4, "%03d", (wndCenter < 0) ? (wndCenter + 360) : wndCenter); - drawTextCenter(xCenter, yOffset - 11, sWndLbl); - epd->drawCircle(xCenter + 25, yOffset - 17, 2, commonData->fgcolor); // symbol - epd->drawCircle(xCenter + 25, yOffset - 17, 3, commonData->fgcolor); // symbol - epd->setCursor(1, yOffset - 3); - snprintf(sWndLbl, 4, "%03d", (wndLeft < 0) ? (wndLeft + 360) : wndLeft); - epd->print(sWndLbl); // Wind left value - epd->drawCircle(46, yOffset - 17, 2, commonData->fgcolor); // symbol - epd->drawCircle(46, yOffset - 17, 3, commonData->fgcolor); // symbol - epd->setCursor(width - 50, yOffset - 3); - snprintf(sWndLbl, 4, "%03d", (wndRight < 0) ? (wndRight + 360) : wndRight); - epd->print(sWndLbl); // Wind right value - epd->drawCircle(width - 5, yOffset - 17, 2, commonData->fgcolor); // symbol - epd->drawCircle(width - 5, yOffset - 17, 3, commonData->fgcolor); // symbol - - if (wdHstry->getMax() == wdMAX_VAL) { - // only values in buffer -> no valid wind data available - wndDataValid = false; - } else if (!BDataValid[0] && !simulation) { - // currently no valid xWD data available and no simulation mode - numNoData++; - wndDataValid = true; - if (numNoData > 3) { - // If more than 4 invalid values in a row, send message - wndDataValid = false; - } - } else { - numNoData = 0; // reset data error counter - wndDataValid = true; // At least some wind data available - } - // Draw wind values in chart - //*********************************************************************** - if (wndDataValid) { - for (int i = 0; i < (numWndVals / dataIntv); i++) { - chrtVal = static_cast(wdHstry->get(bufStart + (i * dataIntv))); // show the latest wind values in buffer; keep 1st value constant in a rolling buffer - if (chrtVal == wdMAX_VAL) { - chrtPrevVal = wdMAX_VAL; - } else { - chrtVal = static_cast((chrtVal / 1000.0 * radToDeg) + 0.5); // Convert to degrees and round - x = ((chrtVal - wndLeft + 360) % 360) * chrtScl; - y = yOffset + cHeight - i; // Position in chart area - - if (i >= (numWndVals / dataIntv) - 1) // log chart data of 1 line (adjust for test purposes) - logger->logDebug(GwLog::DEBUG, "PageWindPlot Chart: i: %d, chrtVal: %d, bufStart: %d, count: %d, linesToShow: %d", i, chrtVal, bufStart, count, (numWndVals / dataIntv)); - - if ((i == 0) || (chrtPrevVal == wdMAX_VAL)) { - // just a dot for 1st chart point or after some invalid values - prevX = x; - prevY = y; - } else { - // cross borders check; shift values to [-180..0..180]; when crossing borders, range is 2x 180 degrees - int wndLeftDlt = -180 - ((wndLeft >= 180) ? (wndLeft - 360) : wndLeft); - int chrtVal180 = ((chrtVal + wndLeftDlt + 180) % 360 + 360) % 360 - 180; - int chrtPrevVal180 = ((chrtPrevVal + wndLeftDlt + 180) % 360 + 360) % 360 - 180; - if (((chrtPrevVal180 >= -180) && (chrtPrevVal180 < -90) && (chrtVal180 > 90)) || ((chrtPrevVal180 <= 179) && (chrtPrevVal180 > 90) && chrtVal180 <= -90)) { - // If current value crosses chart borders compared to previous value, split line - int xSplit = (((chrtPrevVal180 > 0 ? wndRight : wndLeft) - wndLeft + 360) % 360) * chrtScl; - epd->drawLine(prevX, prevY, xSplit, y, commonData->fgcolor); - epd->drawLine(prevX, prevY - 1, ((xSplit != prevX) ? xSplit : xSplit - 1), ((xSplit != prevX) ? y - 1 : y), commonData->fgcolor); - prevX = (((chrtVal180 > 0 ? wndRight : wndLeft) - wndLeft + 360) % 360) * chrtScl; - } - } - - // Draw line with 2 pixels width + make sure vertical line are drawn correctly - epd->drawLine(prevX, prevY, x, y, commonData->fgcolor); - epd->drawLine(prevX, prevY - 1, ((x != prevX) ? x : x - 1), ((x != prevX) ? y - 1 : y), commonData->fgcolor); - chrtPrevVal = chrtVal; - prevX = x; - prevY = y; - } - // Reaching chart area top end - if (i >= (cHeight - 1)) { - oldDataIntv = 0; // force reset of buffer start and number of values to show in next display loop - - int minWndDir = wdHstry->getMin(numWndVals) / 1000.0 * radToDeg; - int maxWndDir = wdHstry->getMax(numWndVals) / 1000.0 * radToDeg; - logger->logDebug(GwLog::DEBUG, "PageWindPlot FreeTop: Minimum: %d, Maximum: %d, OldwndCenter: %d", minWndDir, maxWndDir, wndCenter); - // if (((minWndDir - wndCenter >= 0) && (minWndDir - wndCenter < 180)) || ((maxWndDir - wndCenter <= 0) && (maxWndDir - wndCenter >=180))) { - if ((wndRight > wndCenter && (minWndDir >= wndCenter && minWndDir <= wndRight)) || (wndRight <= wndCenter && (minWndDir >= wndCenter || minWndDir <= wndRight)) || (wndLeft < wndCenter && (maxWndDir <= wndCenter && maxWndDir >= wndLeft)) || (wndLeft >= wndCenter && (maxWndDir <= wndCenter || maxWndDir >= wndLeft))) { - // Check if all wind value are left or right of center value -> optimize chart center - wndCenter = getCntr(*wdHstry, numWndVals); - } - logger->logDebug(GwLog::DEBUG, "PageWindPlot FreeTop: cHeight: %d, bufStart: %d, numWndVals: %d, wndCenter: %d", cHeight, bufStart, numWndVals, wndCenter); - break; - } + if (chrtMode == DIRECTION) { + if (wdChart) { + wdChart->showChrt(VERTICAL, FULL_SIZE, dataIntv, PRNT_NAME, PRNT_VALUE, *wdBVal); } - // Print wind speed value - int currentZone; - static int lastZone = 0; - static bool flipTws = false; - int xPosTws; - static const int yPosTws = yOffset + 40; - - xPosTws = flipTws ? 20 : width - 145; - currentZone = (y >= yPosTws - 38) && (y <= yPosTws + 6) && (x >= xPosTws - 4) && (x <= xPosTws + 146) ? 1 : 0; // Define current zone for TWS value - if (currentZone != lastZone) { - // Only flip when x moves to a different zone - if ((y >= yPosTws - 38) && (y <= yPosTws + 6) && (x >= xPosTws - 4) && (x <= xPosTws + 146)) { - flipTws = !flipTws; - xPosTws = flipTws ? 20 : width - 145; - } + } else if (chrtMode == SPEED) { + if (wsChart) { + wsChart->showChrt(HORIZONTAL, FULL_SIZE, dataIntv, PRNT_NAME, PRNT_VALUE, *wsBVal); } - lastZone = currentZone; - wsValue = wsHstry->getLast(); - wsBVal->value = wsValue / 1000.0; // temp variable to retreive data unit from OBP60Formater - wsBVal->valid = (static_cast(wsValue) != wsHstry->getMinVal()); - String swsValue = commonData->fmt->formatValue(wsBVal, *commonData).svalue; // value (string) - wsUnit = commonData->fmt->formatValue(wsBVal, *commonData).unit; // Unit of value - epd->fillRect(xPosTws - 4, yPosTws - 38, 142, 44, commonData->bgcolor); // Clear area for TWS value - epd->setFont(&DSEG7Classic_BoldItalic16pt7b); - epd->setCursor(xPosTws, yPosTws); - epd->print(swsValue); // Value -/* if (!wsBVal->valid) { - epd->print("--.-"); - } else { - wsValue = wsValue / 10.0 * 1.94384; // Wind speed value in knots - if (wsValue < 10.0) { - epd->printf("!%3.1f", wsValue); // Value, round to 1 decimal - } else { - epd->printf("%4.1f", wsValue); // Value, round to 1 decimal - } - } */ - epd->setFont(&Ubuntu_Bold12pt8b); - epd->setCursor(xPosTws + 82, yPosTws - 14); - epd->print(wsName); // Name - epd->setFont(&Ubuntu_Bold8pt8b); - epd->setCursor(xPosTws + 82, yPosTws + 1); - epd->print(wsUnit); // Unit - - } else { - // No valid data available - LOG_DEBUG(GwLog::LOG, "PageWindPlot: No valid data available"); - epd->setFont(&Ubuntu_Bold10pt8b); - epd->fillRect(xCenter - 33, height / 2 - 20, 66, 24, commonData->bgcolor); // Clear area for message - drawTextCenter(xCenter, height / 2 - 10, "No data"); + } else if (chrtMode == BOTH) { + if (wdChart) { + wdChart->showChrt(VERTICAL, HALF_SIZE_LEFT, dataIntv, PRNT_NAME, PRNT_VALUE, *wdBVal); + } + if (wsChart) { + wsChart->showChrt(VERTICAL, HALF_SIZE_RIGHT, dataIntv, PRNT_NAME, PRNT_VALUE, *wsBVal); + } } - // chart Y axis labels; print at last to overwrite potential chart lines in label area - int yPos; - int chrtLbl; - epd->setFont(&Ubuntu_Bold8pt8b); - for (int i = 1; i <= 3; i++) { - yPos = yOffset + (i * 60); - epd->fillRect(0, yPos, width, 1, commonData->fgcolor); - epd->fillRect(0, yPos - 8, 24, 16, commonData->bgcolor); // Clear small area to remove potential chart lines - epd->setCursor(1, yPos + 4); - if (count >= intvBufSize) { - // Calculate minute value for label - chrtLbl = ((i - 1 + (prevY < yOffset + 30)) * dataIntv) * -1; // change label if last data point is more than 30 lines (= seconds) from chart line - } else { - int j = 3 - i; - chrtLbl = (int((((numWndVals / dataIntv) - 50) * dataIntv / 60) + 1) - (j * dataIntv)) * -1; // 50 lines left below last chart line - } - epd->printf("%3d", chrtLbl); // Wind value label - } - - logger->logDebug(GwLog::DEBUG, "PageWindPlot time: %ld", millis() - timer); + // logger->logDebug(GwLog::DEBUG, "PageWindPlot: page time %ldms", millis() - pageTime); return PAGE_UPDATE; - }; + } }; static Page* createPage(CommonData& common) @@ -512,7 +256,7 @@ PageDescription registerPageWindPlot( "WindPlot", // Page name createPage, // Action 0, // Number of bus values depends on selection in Web configuration - { "TWD", "AWD"}, // Bus values we need in the page + { "TWD", "TWS", "AWD", "AWS" }, // Bus values we need in the page true // Show display header on/off ); diff --git a/lib/obp60task/PageWindRose.cpp b/lib/obp60task/PageWindRose.cpp index 0a98b94..cfa55d0 100644 --- a/lib/obp60task/PageWindRose.cpp +++ b/lib/obp60task/PageWindRose.cpp @@ -4,10 +4,6 @@ #include "Pagedata.h" #include "OBP60Extensions.h" -#ifdef ENABLE_CALIBRATION -#include "BoatDataCalibration.h" -#endif - class PageWindRose : public Page { private: @@ -45,20 +41,18 @@ public: int displayPage(PageData &pageData) { - // storage for hold valued + // storage for hold values static FormattedData bvf_awa_old; static FormattedData bvf_aws_old; static FormattedData bvf_twd_old; static FormattedData bvf_tws_old; static FormattedData bvf_dbt_old; static FormattedData bvf_stw_old; + // units? why? // Get boat value for AWA GwApi::BoatValue *bv_awa = pageData.values[0]; // First element in list String name_awa = xdrDelete(bv_awa->getName(), 6); // get name without prefix and limit length -#ifdef ENABLE_CALIBRATION - calibrationData.calibrateInstance(bv_awa, logger); // Check if boat data value is to be calibrated -#endif FormattedData bvf_awa = commonData->fmt->formatValue(bv_awa, *commonData); if (bv_awa->valid) { // Save formatted data for hold feature bvf_awa_old = bvf_awa; @@ -67,9 +61,6 @@ public: // Get boat value for AWS GwApi::BoatValue *bv_aws = pageData.values[1]; // Second element in list String name_aws = xdrDelete(bv_aws->getName(), 6); // get name without prefix and limit length -#ifdef ENABLE_CALIBRATION - calibrationData.calibrateInstance(bv_aws, logger); // Check if boat data value is to be calibrated -#endif FormattedData bvf_aws = commonData->fmt->formatValue(bv_aws, *commonData); if (bv_aws->valid) { // Save formatted data for hold feature bvf_aws_old = bvf_aws; diff --git a/lib/obp60task/Pagedata.h b/lib/obp60task/Pagedata.h index c710acf..036fbae 100644 --- a/lib/obp60task/Pagedata.h +++ b/lib/obp60task/Pagedata.h @@ -6,19 +6,21 @@ #include #include #include "LedSpiTask.h" -#include "OBPDataOperations.h" +// #include "OBPDataOperations.h" #define MAX_PAGE_NUMBER 10 // Max number of pages for show data typedef std::vector ValueList; +class HstryBuffers; + typedef struct{ GwApi *api; String pageName; uint8_t pageNumber; // page number in sequence of visible pages //the values will always contain the user defined values first ValueList values; - HstryBuf* boatHstry; + HstryBuffers* hstryBuffers; // list of all boat history buffers } PageData; // Sensor data structure (only for extended sensors, not for NMEA bus sensors) diff --git a/lib/obp60task/config_obp40.json b/lib/obp60task/config_obp40.json index 6554839..a68df95 100644 --- a/lib/obp60task/config_obp40.json +++ b/lib/obp60task/config_obp40.json @@ -238,7 +238,7 @@ "label": "Calculate True Wind", "type": "boolean", "default": "false", - "description": "If not available, calculate true wind data from appearant wind and other boat data", + "description": "If not available, calculate true wind data from apparent wind and other boat data", "category": "OBP40 Settings", "capabilities": { "obp40": "true" @@ -686,6 +686,61 @@ "obp40": "true" } }, + { + "name": "mod1Out1", + "label": "Name1", + "type": "string", + "default": "text1", + "description": "Button name", + "category": "OBP60 IO-Modul1", + "capabilities": { + "obp40":"true" + } + }, + { + "name": "mod1Out2", + "label": "Name2", + "type": "string", + "default": "text2", + "description": "Button name", + "category": "OBP60 IO-Modul1", + "capabilities": { + "obp40":"true" + } + }, + { + "name": "mod1Out3", + "label": "Name3", + "type": "string", + "default": "text3", + "description": "Button name", + "category": "OBP60 IO-Modul1", + "capabilities": { + "obp40":"true" + } + }, + { + "name": "mod1Out4", + "label": "Name4", + "type": "string", + "default": "text4", + "description": "Button name", + "category": "OBP60 IO-Modul1", + "capabilities": { + "obp40":"true" + } + }, + { + "name": "mod1Out5", + "label": "Name5", + "type": "string", + "default": "text5", + "description": "Button name", + "category": "OBP60 IO-Modul1", + "capabilities": { + "obp40":"true" + } + }, { "name": "tSensitivity", "label": "Touch Sensitivity [%]", @@ -733,8 +788,10 @@ "AWA", "AWS", "COG", + "DBS", "DBT", "HDM", + "HDT", "PRPOS", "RPOS", "SOG", @@ -760,44 +817,22 @@ "obp40":"true" }, "condition": [ - { "calInstance1": "AWA" }, - { "calInstance1": "AWS" }, - { "calInstance1": "COG" }, - { "calInstance1": "DBT" }, - { "calInstance1": "HDM" }, - { "calInstance1": "PRPOS" }, - { "calInstance1": "RPOS" }, - { "calInstance1": "SOG" }, - { "calInstance1": "STW" }, - { "calInstance1": "TWA" }, - { "calInstance1": "TWS" }, - { "calInstance1": "TWD" }, - { "calInstance1": "WTemp" } ] + { "calInstance1": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] }, { "name": "calSlope1", "label": "Data Instance 1 Calibration Slope", "type": "number", "default": "1.00", - "description": "Slope for data instance 1", + "description": "Slope for data instance 1, Default: 1(!)", "category": "OBP40 Calibrations", "capabilities": { "obp40":"true" }, "condition": [ - { "calInstance1": "AWA" }, - { "calInstance1": "AWS" }, - { "calInstance1": "COG" }, - { "calInstance1": "DBT" }, - { "calInstance1": "HDM" }, - { "calInstance1": "PRPOS" }, - { "calInstance1": "RPOS" }, - { "calInstance1": "SOG" }, - { "calInstance1": "STW" }, - { "calInstance1": "TWA" }, - { "calInstance1": "TWS" }, - { "calInstance1": "TWD" }, - { "calInstance1": "WTemp" } ] + { "calInstance1": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] }, { "name": "calSmooth1", @@ -813,19 +848,8 @@ "obp40":"true" }, "condition": [ - { "calInstance1": "AWA" }, - { "calInstance1": "AWS" }, - { "calInstance1": "COG" }, - { "calInstance1": "DBT" }, - { "calInstance1": "HDM" }, - { "calInstance1": "PRPOS" }, - { "calInstance1": "RPOS" }, - { "calInstance1": "SOG" }, - { "calInstance1": "STW" }, - { "calInstance1": "TWA" }, - { "calInstance1": "TWS" }, - { "calInstance1": "TWD" }, - { "calInstance1": "WTemp" } ] + { "calInstance1": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] }, { "name": "calInstance2", @@ -838,8 +862,10 @@ "AWA", "AWS", "COG", + "DBS", "DBT", "HDM", + "HDT", "PRPOS", "RPOS", "SOG", @@ -865,44 +891,22 @@ "obp40":"true" }, "condition": [ - { "calInstance2": "AWA" }, - { "calInstance2": "AWS" }, - { "calInstance2": "COG" }, - { "calInstance2": "DBT" }, - { "calInstance2": "HDM" }, - { "calInstance2": "PRPOS" }, - { "calInstance2": "RPOS" }, - { "calInstance2": "SOG" }, - { "calInstance2": "STW" }, - { "calInstance2": "TWA" }, - { "calInstance2": "TWS" }, - { "calInstance2": "TWD" }, - { "calInstance2": "WTemp" } ] + { "calInstance2": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] }, { "name": "calSlope2", "label": "Data Instance 2 Calibration Slope", "type": "number", "default": "1.00", - "description": "Slope for data instance 2", + "description": "Slope for data instance 2; Default: 1(!)", "category": "OBP40 Calibrations", "capabilities": { "obp40":"true" }, "condition": [ - { "calInstance2": "AWA" }, - { "calInstance2": "AWS" }, - { "calInstance2": "COG" }, - { "calInstance2": "DBT" }, - { "calInstance2": "HDM" }, - { "calInstance2": "PRPOS" }, - { "calInstance2": "RPOS" }, - { "calInstance2": "SOG" }, - { "calInstance2": "STW" }, - { "calInstance2": "TWA" }, - { "calInstance2": "TWS" }, - { "calInstance2": "TWD" }, - { "calInstance2": "WTemp" } ] + { "calInstance2": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] }, { "name": "calSmooth2", @@ -918,19 +922,8 @@ "obp40":"true" }, "condition": [ - { "calInstance2": "AWA" }, - { "calInstance2": "AWS" }, - { "calInstance2": "COG" }, - { "calInstance2": "DBT" }, - { "calInstance2": "HDM" }, - { "calInstance2": "PRPOS" }, - { "calInstance2": "RPOS" }, - { "calInstance2": "SOG" }, - { "calInstance2": "STW" }, - { "calInstance2": "TWA" }, - { "calInstance2": "TWS" }, - { "calInstance2": "TWD" }, - { "calInstance2": "WTemp" } ] + { "calInstance2": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] }, { "name": "calInstance3", @@ -943,8 +936,10 @@ "AWA", "AWS", "COG", + "DBS", "DBT", "HDM", + "HDT", "PRPOS", "RPOS", "SOG", @@ -970,44 +965,22 @@ "obp40":"true" }, "condition": [ - { "calInstance3": "AWA" }, - { "calInstance3": "AWS" }, - { "calInstance3": "COG" }, - { "calInstance3": "DBT" }, - { "calInstance3": "HDM" }, - { "calInstance3": "PRPOS" }, - { "calInstance3": "RPOS" }, - { "calInstance3": "SOG" }, - { "calInstance3": "STW" }, - { "calInstance3": "TWA" }, - { "calInstance3": "TWS" }, - { "calInstance3": "TWD" }, - { "calInstance3": "WTemp" } ] + { "calInstance3": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] }, { "name": "calSlope3", "label": "Data Instance 3 Calibration Slope", "type": "number", "default": "1.00", - "description": "Slope for data instance 3", + "description": "Slope for data instance 3, Default: 1(!)", "category": "OBP40 Calibrations", "capabilities": { "obp40":"true" }, "condition": [ - { "calInstance3": "AWA" }, - { "calInstance3": "AWS" }, - { "calInstance3": "COG" }, - { "calInstance3": "DBT" }, - { "calInstance3": "HDM" }, - { "calInstance3": "PRPOS" }, - { "calInstance3": "RPOS" }, - { "calInstance3": "SOG" }, - { "calInstance3": "STW" }, - { "calInstance3": "TWA" }, - { "calInstance3": "TWS" }, - { "calInstance3": "TWD" }, - { "calInstance3": "WTemp" } ] + { "calInstance3": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] }, { "name": "calSmooth3", @@ -1023,19 +996,221 @@ "obp40":"true" }, "condition": [ - { "calInstance3": "AWA" }, - { "calInstance3": "AWS" }, - { "calInstance3": "COG" }, - { "calInstance3": "DBT" }, - { "calInstance3": "HDM" }, - { "calInstance3": "PRPOS" }, - { "calInstance3": "RPOS" }, - { "calInstance3": "SOG" }, - { "calInstance3": "STW" }, - { "calInstance3": "TWA" }, - { "calInstance3": "TWS" }, - { "calInstance3": "TWD" }, - { "calInstance3": "WTemp" } ] + { "calInstance3": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] + }, + { + "name": "calInstance4", + "label": "Calibration Data Instance 4", + "type": "list", + "default": "---", + "description": "Data instance for calibration", + "list": [ + "---", + "AWA", + "AWS", + "COG", + "DBS", + "DBT", + "HDM", + "HDT", + "PRPOS", + "RPOS", + "SOG", + "STW", + "TWA", + "TWS", + "TWD", + "WTemp" + ], + "category": "OBP40 Calibrations", + "capabilities": { + "obp40": "true" + } + }, + { + "name": "calOffset4", + "label": "Data Instance 4 Calibration Offset", + "type": "number", + "default": "0.00", + "description": "Offset for data instance 4", + "category": "OBP40 Calibrations", + "capabilities": { + "obp40":"true" + }, + "condition": [ + { "calInstance4": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] + }, + { + "name": "calSlope4", + "label": "Data Instance 4 Calibration Slope", + "type": "number", + "default": "1.00", + "description": "Slope for data instance 4, Default: 1(!)", + "category": "OBP40 Calibrations", + "capabilities": { + "obp40":"true" + }, + "condition": [ + { "calInstance4": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] + }, + { + "name": "calSmooth4", + "label": "Data Instance 4 Smoothing", + "type": "number", + "default": "0", + "check": "checkMinMax", + "min": 0, + "max": 10, + "description": "Smoothing factor [0..10]; 0 = no smoothing", + "category": "OBP40 Calibrations", + "capabilities": { + "obp40":"true" + }, + "condition": [ + { "calInstance4": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] + }, + { + "name": "mapsource", + "label": "Map Source", + "type": "list", + "default": "OBP Service", + "description": "Type of map source, cloud service or local service", + "list": [ + "OBP Service", + "Local Service" + ], + "category": "OBP40 Navigation", + "capabilities": { + "obp40":"true" + } + }, + { + "name": "ipAddress", + "label": "IP Address", + "type": "string", + "default": "192.168.15.10", + "check": "checkIpAddress", + "description": "IP address for local map service e.g. 192.168.15.10\nor an MDNS name like Raspi.local", + "category": "OBP40 Navigation", + "capabilities": { + "obp40":"true" + }, + "condition": [ + { "mapsource": ["Local Service"] } + ] + }, + { + "name": "localPort", + "label": "Port", + "type": "number", + "default": "8080", + "check":"checkPort", + "description": "TCP port for local map server", + "category": "OBP40 Navigation", + "capabilities": { + "obp40":"true" + }, + "condition": [ + { "mapsource": ["Local Service"] } + ] + }, + { + "name": "maptype", + "label": "Map Type", + "type": "list", + "default": "Open Street Map", + "description": "Type of base navigation map with sea marks overlay", + "list": [ + "Open Street Map", + "Google Street", + "Open Topo Map", + "Stadimaps Toner", + "Free Nautical Chart" + ], + "category": "OBP40 Navigation", + "capabilities": { + "obp40":"true" + } + }, + { + "name": "refreshDistance", + "label": "Refresh Distance [m]", + "type": "number", + "default": "15", + "check": "checkMinMax", + "min": 1, + "max": 50, + "description": "Refresh distance between updates [1..50 m], 15 m = default", + "category": "OBP40 Navigation", + "capabilities": { + "obp40":"true" + } + }, + { + "name": "zoomlevel", + "label": "Default Zoom Level", + "type": "number", + "default": "15", + "check": "checkMinMax", + "min": 7, + "max": 17, + "description": "Start zoom level for map [7..17]; 15 = default", + "category": "OBP40 Navigation", + "capabilities": { + "obp40":"true" + } + }, + { + "name": "orientation", + "label": "Map Orientation", + "type": "list", + "default": "North Dirirection", + "description": "Map orientation for navigation", + "list": [ + "North Direction", + "Travel Direction" + ], + "category": "OBP40 Navigation", + "capabilities": { + "obp40":"true" + } + }, + { + "name": "grid", + "label": "Show Grid", + "type": "boolean", + "default": "false", + "description": "Show the grid for latutude and longitude", + "category": "OBP40 Navigation", + "capabilities": { + "obp40": "true" + } + }, + { + "name": "showvalues", + "label": "Show Values", + "type": "boolean", + "default": "false", + "description": "Show boat data values in the left upper map corner", + "category": "OBP40 Navigation", + "capabilities": { + "obp40": "true" + } + }, + { + "name": "ownheading", + "label": "Alternativ Heading", + "type": "boolean", + "default": "false", + "description": "Calculating an alternative travel direction for\na better and calmer map orientation", + "category": "OBP40 Navigation", + "capabilities": { + "obp40": "true" + } }, { "name": "display", @@ -1085,7 +1260,7 @@ "label": "Status Time Source", "type": "list", "default": "GPS", - "description": "Data source for date and time display in status line [RTC|iRTC|GPS]", + "description": "Data source for date and time display in status line [iRTC|RTC|GPS]", "list": [ {"l":"Internal real time clock (iRTC)","v":"iRTC"}, {"l":"External real time clock (RTC)","v":"RTC"}, @@ -1219,9 +1394,9 @@ "type": "number", "default": "50", "check": "checkMinMax", - "min": 20, + "min": 5, "max": 100, - "description": "Backlight brightness [20...100%]", + "description": "Backlight brightness [5...100%]", "category": "OBP40 Display", "capabilities": { "obp40": "false" @@ -1378,12 +1553,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -1405,38 +1582,20 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "visiblePages": 1 - }, - { - "visiblePages": 2 - }, - { - "visiblePages": 3 - }, - { - "visiblePages": 4 - }, - { - "visiblePages": 5 - }, - { - "visiblePages": 6 - }, - { - "visiblePages": 7 - }, - { - "visiblePages": 8 - }, - { - "visiblePages": 9 - }, - { - "visiblePages": 10 - } - ] + "condition": { + "visiblePages": [ + 1, + 2, + 3, + 4, + 5, + 6, + 7, + 8, + 9, + 10 + ] + } }, { "name": "page1value1", @@ -1669,31 +1828,51 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "page1type": "Fluid" - } - ] + "condition": { + "page1type": "Fluid", + "visiblePages": [ + "1", + "2", + "3", + "4", + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page1wndsrc", "label": "Wind source", "type": "list", "default": "True wind", - "description": "Wind source for page 1: [true|apparant]", + "description": "Wind source for page 1: [true|apparent]", "list": [ "True wind", - "Apparant wind" + "Apparent wind" ], "category": "OBP40 Page 1", "capabilities": { "obp40": "true" }, - "condition": [ - { - "page1type": "WindPlot" - } - ] + "condition": { + "page1type": "WindPlot", + "visiblePages": [ + "1", + "2", + "3", + "4", + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page2type", @@ -1710,12 +1889,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -1737,35 +1918,19 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "visiblePages": 2 - }, - { - "visiblePages": 3 - }, - { - "visiblePages": 4 - }, - { - "visiblePages": 5 - }, - { - "visiblePages": 6 - }, - { - "visiblePages": 7 - }, - { - "visiblePages": 8 - }, - { - "visiblePages": 9 - }, - { - "visiblePages": 10 - } - ] + "condition": { + "visiblePages": [ + "2", + "3", + "4", + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page2value1", @@ -1992,31 +2157,49 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "page2type": "Fluid" - } - ] + "condition": { + "page2type": "Fluid", + "visiblePages": [ + "2", + "3", + "4", + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page2wndsrc", "label": "Wind source", "type": "list", "default": "True wind", - "description": "Wind source for page 2: [true|apparant]", + "description": "Wind source for page 2: [true|apparent]", "list": [ "True wind", - "Apparant wind" + "Apparent wind" ], "category": "OBP40 Page 2", "capabilities": { "obp40": "true" }, - "condition": [ - { - "page2type": "WindPlot" - } - ] + "condition": { + "page2type": "WindPlot", + "visiblePages": [ + "2", + "3", + "4", + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page3type", @@ -2033,12 +2216,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -2306,31 +2491,47 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "page3type": "Fluid" - } - ] + "condition": { + "page3type": "Fluid", + "visiblePages": [ + "3", + "4", + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page3wndsrc", "label": "Wind source", "type": "list", "default": "True wind", - "description": "Wind source for page 3: [true|apparant]", + "description": "Wind source for page 3: [true|apparent]", "list": [ "True wind", - "Apparant wind" + "Apparent wind" ], "category": "OBP40 Page 3", "capabilities": { "obp40": "true" }, - "condition": [ - { - "page3type": "WindPlot" - } - ] + "condition": { + "page3type": "WindPlot", + "visiblePages": [ + "3", + "4", + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page4type", @@ -2347,12 +2548,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -2611,31 +2814,45 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "page4type": "Fluid" - } - ] + "condition": { + "page4type": "Fluid", + "visiblePages": [ + "4", + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page4wndsrc", "label": "Wind source", "type": "list", "default": "True wind", - "description": "Wind source for page 4: [true|apparant]", + "description": "Wind source for page 4: [true|apparent]", "list": [ "True wind", - "Apparant wind" + "Apparent wind" ], "category": "OBP40 Page 4", "capabilities": { "obp40": "true" }, - "condition": [ - { - "page4type": "WindPlot" - } - ] + "condition": { + "page4type": "WindPlot", + "visiblePages": [ + "4", + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page5type", @@ -2652,12 +2869,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -2679,26 +2898,16 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "visiblePages": 5 - }, - { - "visiblePages": 6 - }, - { - "visiblePages": 7 - }, - { - "visiblePages": 8 - }, - { - "visiblePages": 9 - }, - { - "visiblePages": 10 - } - ] + "condition": { + "visiblePages": [ + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page5value1", @@ -2907,31 +3116,43 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "page5type": "Fluid" - } - ] + "condition": { + "page5type": "Fluid", + "visiblePages": [ + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page5wndsrc", "label": "Wind source", "type": "list", "default": "True wind", - "description": "Wind source for page 5: [true|apparant]", + "description": "Wind source for page 5: [true|apparent]", "list": [ "True wind", - "Apparant wind" + "Apparent wind" ], "category": "OBP40 Page 5", "capabilities": { "obp40": "true" }, - "condition": [ - { - "page5type": "WindPlot" - } - ] + "condition": { + "page5type": "WindPlot", + "visiblePages": [ + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page6type", @@ -2948,12 +3169,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -2975,23 +3198,15 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "visiblePages": 6 - }, - { - "visiblePages": 7 - }, - { - "visiblePages": 8 - }, - { - "visiblePages": 9 - }, - { - "visiblePages": 10 - } - ] + "condition": { + "visiblePages": [ + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page6value1", @@ -3194,31 +3409,41 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "page6type": "Fluid" - } - ] + "condition": { + "page6type": "Fluid", + "visiblePages": [ + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page6wndsrc", "label": "Wind source", "type": "list", "default": "True wind", - "description": "Wind source for page 6: [true|apparant]", + "description": "Wind source for page 6: [true|apparent]", "list": [ "True wind", - "Apparant wind" + "Apparent wind" ], "category": "OBP40 Page 6", "capabilities": { "obp40": "true" }, - "condition": [ - { - "page6type": "WindPlot" - } - ] + "condition": { + "page6type": "WindPlot", + "visiblePages": [ + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page7type", @@ -3235,12 +3460,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -3262,20 +3489,14 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "visiblePages": 7 - }, - { - "visiblePages": 8 - }, - { - "visiblePages": 9 - }, - { - "visiblePages": 10 - } - ] + "condition": { + "visiblePages": [ + "7", + "8", + "9", + "10" + ] + } }, { "name": "page7value1", @@ -3472,31 +3693,39 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "page7type": "Fluid" - } - ] + "condition": { + "page7type": "Fluid", + "visiblePages": [ + "7", + "8", + "9", + "10" + ] + } }, { "name": "page7wndsrc", "label": "Wind source", "type": "list", "default": "True wind", - "description": "Wind source for page 7: [true|apparant]", + "description": "Wind source for page 7: [true|apparent]", "list": [ "True wind", - "Apparant wind" + "Apparent wind" ], "category": "OBP40 Page 7", "capabilities": { "obp40": "true" }, - "condition": [ - { - "page7type": "WindPlot" - } - ] + "condition": { + "page7type": "WindPlot", + "visiblePages": [ + "7", + "8", + "9", + "10" + ] + } }, { "name": "page8type", @@ -3513,12 +3742,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -3540,17 +3771,13 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "visiblePages": 8 - }, - { - "visiblePages": 9 - }, - { - "visiblePages": 10 - } - ] + "condition": { + "visiblePages": [ + "8", + "9", + "10" + ] + } }, { "name": "page8value1", @@ -3741,31 +3968,37 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "page8type": "Fluid" - } - ] + "condition": { + "page8type": "Fluid", + "visiblePages": [ + "8", + "9", + "10" + ] + } }, { "name": "page8wndsrc", "label": "Wind source", "type": "list", "default": "True wind", - "description": "Wind source for page 8: [true|apparant]", + "description": "Wind source for page 8: [true|apparent]", "list": [ "True wind", - "Apparant wind" + "Apparent wind" ], "category": "OBP40 Page 8", "capabilities": { "obp40": "true" }, - "condition": [ - { - "page8type": "WindPlot" - } - ] + "condition": { + "page8type": "WindPlot", + "visiblePages": [ + "8", + "9", + "10" + ] + } }, { "name": "page9type", @@ -3782,12 +4015,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -3809,14 +4044,12 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "visiblePages": 9 - }, - { - "visiblePages": 10 - } - ] + "condition": { + "visiblePages": [ + "9", + "10" + ] + } }, { "name": "page9value1", @@ -4001,31 +4234,35 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "page9type": "Fluid" - } - ] + "condition": { + "page9type": "Fluid", + "visiblePages": [ + "9", + "10" + ] + } }, { "name": "page9wndsrc", "label": "Wind source", "type": "list", "default": "True wind", - "description": "Wind source for page 9: [true|apparant]", + "description": "Wind source for page 9: [true|apparent]", "list": [ "True wind", - "Apparant wind" + "Apparent wind" ], "category": "OBP40 Page 9", "capabilities": { "obp40": "true" }, - "condition": [ - { - "page9type": "WindPlot" - } - ] + "condition": { + "page9type": "WindPlot", + "visiblePages": [ + "9", + "10" + ] + } }, { "name": "page10type", @@ -4042,12 +4279,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -4069,11 +4308,11 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "visiblePages": 10 - } - ] + "condition": { + "visiblePages": [ + "10" + ] + } }, { "name": "page10value1", @@ -4252,30 +4491,32 @@ "capabilities": { "obp40": "true" }, - "condition": [ - { - "page10type": "Fluid" - } - ] + "condition": { + "page10type": "Fluid", + "visiblePages": [ + "10" + ] + } }, { "name": "page10wndsrc", "label": "Wind source", "type": "list", "default": "True wind", - "description": "Wind source for page 10: [true|apparant]", + "description": "Wind source for page 10: [true|apparent]", "list": [ "True wind", - "Apparant wind" + "Apparent wind" ], "category": "OBP40 Page 10", "capabilities": { "obp40": "true" }, - "condition": [ - { - "page10type": "WindPlot" - } - ] + "condition": { + "page10type": "WindPlot", + "visiblePages": [ + "10" + ] + } } ] diff --git a/lib/obp60task/config.json b/lib/obp60task/config_obp60.json similarity index 87% rename from lib/obp60task/config.json rename to lib/obp60task/config_obp60.json index f02eb0f..951e469 100644 --- a/lib/obp60task/config.json +++ b/lib/obp60task/config_obp60.json @@ -37,7 +37,7 @@ "name": "homeLAT", "label": "Home latitude", "type": "number", - "default": "", + "default": "0.00000", "check": "checkMinMax", "min": -90.0, "max": 90.0, @@ -51,7 +51,7 @@ "name": "homeLON", "label": "Home longitude", "type": "number", - "default": "", + "default": "0.00000", "check": "checkMinMax", "min": -180.0, "max": 180.0, @@ -238,7 +238,7 @@ "label": "Calculate True Wind", "type": "boolean", "default": "false", - "description": "If not available, calculate true wind data from appearant wind and other boat data", + "description": "If not available, calculate true wind data from apparent wind and other boat data", "category": "OBP60 Settings", "capabilities": { "obp60": "true" @@ -675,6 +675,61 @@ "obp60":"true" } }, + { + "name": "mod1Out1", + "label": "Name1", + "type": "string", + "default": "text1", + "description": "Button name", + "category": "OBP60 IO-Modul1", + "capabilities": { + "obp60":"true" + } + }, + { + "name": "mod1Out2", + "label": "Name2", + "type": "string", + "default": "text2", + "description": "Button name", + "category": "OBP60 IO-Modul1", + "capabilities": { + "obp60":"true" + } + }, + { + "name": "mod1Out3", + "label": "Name3", + "type": "string", + "default": "text3", + "description": "Button name", + "category": "OBP60 IO-Modul1", + "capabilities": { + "obp60":"true" + } + }, + { + "name": "mod1Out4", + "label": "Name4", + "type": "string", + "default": "text4", + "description": "Button name", + "category": "OBP60 IO-Modul1", + "capabilities": { + "obp60":"true" + } + }, + { + "name": "mod1Out5", + "label": "Name5", + "type": "string", + "default": "text5", + "description": "Button name", + "category": "OBP60 IO-Modul1", + "capabilities": { + "obp60":"true" + } + }, { "name": "tSensitivity", "label": "Touch Sensitivity [%]", @@ -722,8 +777,10 @@ "AWA", "AWS", "COG", + "DBS", "DBT", "HDM", + "HDT", "PRPOS", "RPOS", "SOG", @@ -749,44 +806,22 @@ "obp60":"true" }, "condition": [ - { "calInstance1": "AWA" }, - { "calInstance1": "AWS" }, - { "calInstance1": "COG" }, - { "calInstance1": "DBT" }, - { "calInstance1": "HDM" }, - { "calInstance1": "PRPOS" }, - { "calInstance1": "RPOS" }, - { "calInstance1": "SOG" }, - { "calInstance1": "STW" }, - { "calInstance1": "TWA" }, - { "calInstance1": "TWS" }, - { "calInstance1": "TWD" }, - { "calInstance1": "WTemp" } ] + { "calInstance1": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] }, { "name": "calSlope1", "label": "Data Instance 1 Calibration Slope", "type": "number", "default": "1.00", - "description": "Slope for data instance 1", + "description": "Slope for data instance 1; Default: 1(!)", "category": "OBP60 Calibrations", "capabilities": { "obp60":"true" }, "condition": [ - { "calInstance1": "AWA" }, - { "calInstance1": "AWS" }, - { "calInstance1": "COG" }, - { "calInstance1": "DBT" }, - { "calInstance1": "HDM" }, - { "calInstance1": "PRPOS" }, - { "calInstance1": "RPOS" }, - { "calInstance1": "SOG" }, - { "calInstance1": "STW" }, - { "calInstance1": "TWA" }, - { "calInstance1": "TWS" }, - { "calInstance1": "TWD" }, - { "calInstance1": "WTemp" } ] + { "calInstance1": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] }, { "name": "calSmooth1", @@ -802,19 +837,8 @@ "obp60":"true" }, "condition": [ - { "calInstance1": "AWA" }, - { "calInstance1": "AWS" }, - { "calInstance1": "COG" }, - { "calInstance1": "DBT" }, - { "calInstance1": "HDM" }, - { "calInstance1": "PRPOS" }, - { "calInstance1": "RPOS" }, - { "calInstance1": "SOG" }, - { "calInstance1": "STW" }, - { "calInstance1": "TWA" }, - { "calInstance1": "TWS" }, - { "calInstance1": "TWD" }, - { "calInstance1": "WTemp" } ] + { "calInstance1": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] }, { "name": "calInstance2", @@ -827,8 +851,10 @@ "AWA", "AWS", "COG", + "DBS", "DBT", "HDM", + "HDT", "PRPOS", "RPOS", "SOG", @@ -854,44 +880,22 @@ "obp60":"true" }, "condition": [ - { "calInstance2": "AWA" }, - { "calInstance2": "AWS" }, - { "calInstance2": "COG" }, - { "calInstance2": "DBT" }, - { "calInstance2": "HDM" }, - { "calInstance2": "PRPOS" }, - { "calInstance2": "RPOS" }, - { "calInstance2": "SOG" }, - { "calInstance2": "STW" }, - { "calInstance2": "TWA" }, - { "calInstance2": "TWS" }, - { "calInstance2": "TWD" }, - { "calInstance2": "WTemp" } ] + { "calInstance2": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] }, { "name": "calSlope2", "label": "Data Instance 2 Calibration Slope", "type": "number", "default": "1.00", - "description": "Slope for data instance 2", + "description": "Slope for data instance 2; Default: 1(!)", "category": "OBP60 Calibrations", "capabilities": { "obp60":"true" }, "condition": [ - { "calInstance2": "AWA" }, - { "calInstance2": "AWS" }, - { "calInstance2": "COG" }, - { "calInstance2": "DBT" }, - { "calInstance2": "HDM" }, - { "calInstance2": "PRPOS" }, - { "calInstance2": "RPOS" }, - { "calInstance2": "SOG" }, - { "calInstance2": "STW" }, - { "calInstance2": "TWA" }, - { "calInstance2": "TWS" }, - { "calInstance2": "TWD" }, - { "calInstance2": "WTemp" } ] + { "calInstance2": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] }, { "name": "calSmooth2", @@ -907,19 +911,8 @@ "obp60":"true" }, "condition": [ - { "calInstance2": "AWA" }, - { "calInstance2": "AWS" }, - { "calInstance2": "COG" }, - { "calInstance2": "DBT" }, - { "calInstance2": "HDM" }, - { "calInstance2": "PRPOS" }, - { "calInstance2": "RPOS" }, - { "calInstance2": "SOG" }, - { "calInstance2": "STW" }, - { "calInstance2": "TWA" }, - { "calInstance2": "TWS" }, - { "calInstance2": "TWD" }, - { "calInstance2": "WTemp" } ] + { "calInstance2": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] }, { "name": "calInstance3", @@ -932,8 +925,10 @@ "AWA", "AWS", "COG", + "DBS", "DBT", "HDM", + "HDT", "PRPOS", "RPOS", "SOG", @@ -959,44 +954,22 @@ "obp60":"true" }, "condition": [ - { "calInstance3": "AWA" }, - { "calInstance3": "AWS" }, - { "calInstance3": "COG" }, - { "calInstance3": "DBT" }, - { "calInstance3": "HDM" }, - { "calInstance3": "PRPOS" }, - { "calInstance3": "RPOS" }, - { "calInstance3": "SOG" }, - { "calInstance3": "STW" }, - { "calInstance3": "TWA" }, - { "calInstance3": "TWS" }, - { "calInstance3": "TWD" }, - { "calInstance3": "WTemp" } ] + { "calInstance3": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] }, { "name": "calSlope3", "label": "Data Instance 3 Calibration Slope", "type": "number", "default": "1.00", - "description": "Slope for data instance 3", + "description": "Slope for data instance 3; Default: 1(!)", "category": "OBP60 Calibrations", "capabilities": { "obp60":"true" }, "condition": [ - { "calInstance3": "AWA" }, - { "calInstance3": "AWS" }, - { "calInstance3": "COG" }, - { "calInstance3": "DBT" }, - { "calInstance3": "HDM" }, - { "calInstance3": "PRPOS" }, - { "calInstance3": "RPOS" }, - { "calInstance3": "SOG" }, - { "calInstance3": "STW" }, - { "calInstance3": "TWA" }, - { "calInstance3": "TWS" }, - { "calInstance3": "TWD" }, - { "calInstance3": "WTemp" } ] + { "calInstance3": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] }, { "name": "calSmooth3", @@ -1012,19 +985,221 @@ "obp60":"true" }, "condition": [ - { "calInstance3": "AWA" }, - { "calInstance3": "AWS" }, - { "calInstance3": "COG" }, - { "calInstance3": "DBT" }, - { "calInstance3": "HDM" }, - { "calInstance3": "PRPOS" }, - { "calInstance3": "RPOS" }, - { "calInstance3": "SOG" }, - { "calInstance3": "STW" }, - { "calInstance3": "TWA" }, - { "calInstance3": "TWS" }, - { "calInstance3": "TWD" }, - { "calInstance3": "WTemp" } ] + { "calInstance3": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] + }, + { + "name": "calInstance4", + "label": "Calibration Data Instance 4", + "type": "list", + "default": "---", + "description": "Data instance for calibration", + "list": [ + "---", + "AWA", + "AWS", + "COG", + "DBS", + "DBT", + "HDM", + "HDT", + "PRPOS", + "RPOS", + "SOG", + "STW", + "TWA", + "TWS", + "TWD", + "WTemp" + ], + "category": "OBP60 Calibrations", + "capabilities": { + "obp60":"true" + } + }, + { + "name": "calOffset4", + "label": "Data Instance 4 Calibration Offset", + "type": "number", + "default": "0.00", + "description": "Offset for data instance 4", + "category": "OBP60 Calibrations", + "capabilities": { + "obp60":"true" + }, + "condition": [ + { "calInstance4": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] + }, + { + "name": "calSlope4", + "label": "Data Instance 4 Calibration Slope", + "type": "number", + "default": "1.00", + "description": "Slope for data instance 3; Default: 1(!)", + "category": "OBP60 Calibrations", + "capabilities": { + "obp60":"true" + }, + "condition": [ + { "calInstance4": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] + }, + { + "name": "calSmooth4", + "label": "Data Instance 4 Smoothing", + "type": "number", + "default": "0", + "check": "checkMinMax", + "min": 0, + "max": 10, + "description": "Smoothing factor [0..10]; 0 = no smoothing", + "category": "OBP60 Calibrations", + "capabilities": { + "obp60":"true" + }, + "condition": [ + { "calInstance4": ["AWA", "AWS", "COG", "DBS", "DBT", "HDM", "HDT", "PRPOS", "RPOS", "SOG", "STW", "TWA", "TWS", "TWD", "WTemp" ] } + ] + }, + { + "name": "mapsource", + "label": "Map Source", + "type": "list", + "default": "OBP Service", + "description": "Type of map source, cloud service or local service", + "list": [ + "OBP Service", + "Local Service" + ], + "category": "OBP60 Navigation", + "capabilities": { + "obp60":"true" + } + }, + { + "name": "ipAddress", + "label": "IP Address", + "type": "string", + "default": "192.168.15.10", + "check": "checkIpAddress", + "description": "IP address for local map service e.g. 192.168.15.10\nor an MDNS name like Raspi.local", + "category": "OBP60 Navigation", + "capabilities": { + "obp60":"true" + }, + "condition": [ + { "mapsource": ["Local Service"] } + ] + }, + { + "name": "localPort", + "label": "Port", + "type": "number", + "default": "8080", + "check":"checkPort", + "description": "TCP port for local map server", + "category": "OBP60 Navigation", + "capabilities": { + "obp60":"true" + }, + "condition": [ + { "mapsource": ["Local Service"] } + ] + }, + { + "name": "maptype", + "label": "Map Type", + "type": "list", + "default": "Open Street Map", + "description": "Type of base navigation map with sea marks overlay", + "list": [ + "Open Street Map", + "Google Street", + "Open Topo Map", + "Stadimaps Toner", + "Free Nautical Chart" + ], + "category": "OBP60 Navigation", + "capabilities": { + "obp60":"true" + } + }, + { + "name": "refreshDistance", + "label": "Refresh Distance [m]", + "type": "number", + "default": "15", + "check": "checkMinMax", + "min": 1, + "max": 50, + "description": "Refresh distance between updates [1..50 m], 15 m = default", + "category": "OBP60 Navigation", + "capabilities": { + "obp60":"true" + } + }, + { + "name": "zoomlevel", + "label": "Default Zoom Level", + "type": "number", + "default": "15", + "check": "checkMinMax", + "min": 7, + "max": 17, + "description": "Start zoom level for map [7..17]; 15 = default", + "category": "OBP60 Navigation", + "capabilities": { + "obp60":"true" + } + }, + { + "name": "orientation", + "label": "Map Orientation", + "type": "list", + "default": "North Dirirection", + "description": "Map orientation for navigation", + "list": [ + "North Direction", + "Travel Direction" + ], + "category": "OBP60 Navigation", + "capabilities": { + "obp60":"true" + } + }, + { + "name": "grid", + "label": "Show Grid", + "type": "boolean", + "default": "false", + "description": "Show the grid for latutude and longitude", + "category": "OBP60 Navigation", + "capabilities": { + "obp60": "true" + } + }, + { + "name": "showvalues", + "label": "Show Values", + "type": "boolean", + "default": "false", + "description": "Show boat data values in the left upper map corner", + "category": "OBP60 Navigation", + "capabilities": { + "obp60": "true" + } + }, + { + "name": "ownheading", + "label": "Alternativ Heading", + "type": "boolean", + "default": "false", + "description": "Calculating an alternative travel direction for\na better and calmer map orientation", + "category": "OBP60 Navigation", + "capabilities": { + "obp60": "true" + } }, { "name": "display", @@ -1207,9 +1382,9 @@ "type": "number", "default": "50", "check": "checkMinMax", - "min": 20, + "min": 5, "max": 100, - "description": "Backlight brightness [20...100%]", + "description": "Backlight brightness [5...100%]", "category": "OBP60 Display", "capabilities": { "obp60":"true" @@ -1355,12 +1530,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -1382,38 +1559,20 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "visiblePages": 1 - }, - { - "visiblePages": 2 - }, - { - "visiblePages": 3 - }, - { - "visiblePages": 4 - }, - { - "visiblePages": 5 - }, - { - "visiblePages": 6 - }, - { - "visiblePages": 7 - }, - { - "visiblePages": 8 - }, - { - "visiblePages": 9 - }, - { - "visiblePages": 10 - } - ] + "condition": { + "visiblePages": [ + 1, + 2, + 3, + 4, + 5, + 6, + 7, + 8, + 9, + 10 + ] + } }, { "name": "page1value1", @@ -1646,11 +1805,21 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "page1type": "Fluid" - } - ] + "condition": { + "page1type": "Fluid", + "visiblePages": [ + "1", + "2", + "3", + "4", + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page2type", @@ -1667,12 +1836,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -1694,35 +1865,19 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "visiblePages": 2 - }, - { - "visiblePages": 3 - }, - { - "visiblePages": 4 - }, - { - "visiblePages": 5 - }, - { - "visiblePages": 6 - }, - { - "visiblePages": 7 - }, - { - "visiblePages": 8 - }, - { - "visiblePages": 9 - }, - { - "visiblePages": 10 - } - ] + "condition": { + "visiblePages": [ + "2", + "3", + "4", + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page2value1", @@ -1949,11 +2104,20 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "page2type": "Fluid" - } - ] + "condition": { + "page2type": "Fluid", + "visiblePages": [ + "2", + "3", + "4", + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page3type", @@ -1970,12 +2134,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -2243,11 +2409,19 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "page3type": "Fluid" - } - ] + "condition": { + "page3type": "Fluid", + "visiblePages": [ + "3", + "4", + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page4type", @@ -2264,12 +2438,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -2291,29 +2467,17 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "visiblePages": 4 - }, - { - "visiblePages": 5 - }, - { - "visiblePages": 6 - }, - { - "visiblePages": 7 - }, - { - "visiblePages": 8 - }, - { - "visiblePages": 9 - }, - { - "visiblePages": 10 - } - ] + "condition": { + "visiblePages": [ + "4", + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page4value1", @@ -2528,11 +2692,18 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "page4type": "Fluid" - } - ] + "condition": { + "page4type": "Fluid", + "visiblePages": [ + "4", + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page5type", @@ -2549,12 +2720,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -2576,26 +2749,16 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "visiblePages": 5 - }, - { - "visiblePages": 6 - }, - { - "visiblePages": 7 - }, - { - "visiblePages": 8 - }, - { - "visiblePages": 9 - }, - { - "visiblePages": 10 - } - ] + "condition": { + "visiblePages": [ + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page5value1", @@ -2804,11 +2967,17 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "page5type": "Fluid" - } - ] + "condition": { + "page5type": "Fluid", + "visiblePages": [ + "5", + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page6type", @@ -2825,12 +2994,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -2852,23 +3023,15 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "visiblePages": 6 - }, - { - "visiblePages": 7 - }, - { - "visiblePages": 8 - }, - { - "visiblePages": 9 - }, - { - "visiblePages": 10 - } - ] + "condition": { + "visiblePages": [ + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page6value1", @@ -3071,11 +3234,16 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "page6type": "Fluid" - } - ] + "condition": { + "page6type": "Fluid", + "visiblePages": [ + "6", + "7", + "8", + "9", + "10" + ] + } }, { "name": "page7type", @@ -3092,12 +3260,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -3119,20 +3289,14 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "visiblePages": 7 - }, - { - "visiblePages": 8 - }, - { - "visiblePages": 9 - }, - { - "visiblePages": 10 - } - ] + "condition": { + "visiblePages": [ + "7", + "8", + "9", + "10" + ] + } }, { "name": "page7value1", @@ -3329,11 +3493,15 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "page7type": "Fluid" - } - ] + "condition": { + "page7type": "Fluid", + "visiblePages": [ + "7", + "8", + "9", + "10" + ] + } }, { "name": "page8type", @@ -3350,12 +3518,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -3377,17 +3547,13 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "visiblePages": 8 - }, - { - "visiblePages": 9 - }, - { - "visiblePages": 10 - } - ] + "condition": { + "visiblePages": [ + "8", + "9", + "10" + ] + } }, { "name": "page8value1", @@ -3578,11 +3744,14 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "page8type": "Fluid" - } - ] + "condition": { + "page8type": "Fluid", + "visiblePages": [ + "8", + "9", + "10" + ] + } }, { "name": "page9type", @@ -3599,12 +3768,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -3626,14 +3797,12 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "visiblePages": 9 - }, - { - "visiblePages": 10 - } - ] + "condition": { + "visiblePages": [ + "9", + "10" + ] + } }, { "name": "page9value1", @@ -3818,11 +3987,13 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "page9type": "Fluid" - } - ] + "condition": { + "page9type": "Fluid", + "visiblePages": [ + "9", + "10" + ] + } }, { "name": "page10type", @@ -3839,12 +4010,14 @@ "Battery2", "Clock", "Compass", + "DigitalOut", "DST810", "Fluid", "FourValues", "FourValues2", "Generator", "KeelPosition", + "Navigation", "OneValue", "RollPitch", "RudderPosition", @@ -4049,10 +4222,11 @@ "capabilities": { "obp60": "true" }, - "condition": [ - { - "page10type": "Fluid" - } - ] + "condition": { + "page10type": "Fluid", + "visiblePages": [ + "10" + ] + } } ] diff --git a/lib/obp60task/extra_task.py b/lib/obp60task/extra_task.py index eada874..8a5d97c 100644 --- a/lib/obp60task/extra_task.py +++ b/lib/obp60task/extra_task.py @@ -1,12 +1,29 @@ # PlatformIO extra script for obp60task +import subprocess + +def cleanup_patches(source, target, env): + for p in patchfiles: + patch = os.path.join(patchdir, p) + print(f"removing {patch}") + res = subprocess.run(["git", "apply", "-R", patch], capture_output=True, text=True) + if res.returncode != 0: + print(res.stderr) + +patching = False + epdtype = "unknown" pcbvers = "unknown" for x in env["BUILD_FLAGS"]: - if x.startswith("-D HARDWARE_"): + if not x.startswith('-D'): + continue + opt = x[2:].strip() + if opt.startswith("HARDWARE_"): pcbvers = x.split('_')[1] - if x.startswith("-D DISPLAY_"): + elif opt.startswith("DISPLAY_"): epdtype = x.split('_')[1] + elif opt == 'ENABLE_PATCHES': + patching = True propfilename = os.path.join(env["PROJECT_LIBDEPS_DIR"], env["PIOENV"], "GxEPD2/library.properties") properties = {} @@ -29,3 +46,22 @@ env["CPPDEFINES"].extend([("BOARD", env["BOARD"]), ("EPDTYPE", epdtype), ("PCBVE print("added hardware info to CPPDEFINES") print("friendly board name is '{}'".format(env.GetProjectOption("board_name"))) + +if patching: + # apply patches to gateway code + print("applying gateway patches") + patchdir = os.path.join(os.path.dirname(script), "patches") + if not os.path.isdir(patchdir): + print("patchdir not found, no patches applied") + else: + patchfiles = [f for f in os.listdir(patchdir)] + if len(patchfiles) > 0: + for p in patchfiles: + patch = os.path.join(patchdir, p) + print(f"applying {patch}") + res = subprocess.run(["git", "apply", patch], capture_output=True, text=True) + if res.returncode != 0: + print(res.stderr) + env.AddPostAction("$PROGPATH", cleanup_patches) + else: + print("no patches found") diff --git a/lib/obp60task/fonts/IBM8x8px.h b/lib/obp60task/fonts/IBM8x8px.h new file mode 100644 index 0000000..fb617e6 --- /dev/null +++ b/lib/obp60task/fonts/IBM8x8px.h @@ -0,0 +1,202 @@ +const uint8_t IBM8x8pxBitmaps[] PROGMEM = { + 0x00, /* 0x20 space */ + 0x6F, 0xF6, 0x60, 0x60, /* 0x21 exclam */ + 0xDE, 0xF6, /* 0x22 quotedbl */ + 0x6C, 0xDB, 0xFB, 0x6F, 0xED, 0x9B, 0x00, /* 0x23 numbersign */ + 0x31, 0xFC, 0x1E, 0x0F, 0xE3, 0x00, /* 0x24 dollar */ + 0xC7, 0x98, 0x61, 0x86, 0x78, 0xC0, /* 0x25 percent */ + 0x38, 0xD8, 0xE3, 0xBD, 0xD9, 0x9D, 0x80, /* 0x26 ampersand */ + 0x6F, 0x00, /* 0x27 quotesingle */ + 0x36, 0xCC, 0xC6, 0x30, /* 0x28 parenleft */ + 0xC6, 0x33, 0x36, 0xC0, /* 0x29 parenright */ + 0x66, 0x3C, 0xFF, 0x3C, 0x66, /* 0x2A asterisk */ + 0x30, 0xCF, 0xCC, 0x30, /* 0x2B plus */ + 0x6F, 0x00, /* 0x2C comma */ + 0xFC, /* 0x2D hyphen */ + 0xF0, /* 0x2E period */ + 0x06, 0x18, 0x61, 0x86, 0x18, 0x20, 0x00, /* 0x2F slash */ + 0x7D, 0x8F, 0x3E, 0xFF, 0x7C, 0xDF, 0x00, /* 0x30 zero */ + 0x31, 0xC3, 0x0C, 0x30, 0xCF, 0xC0, /* 0x31 one */ + 0x7B, 0x30, 0xCE, 0x63, 0x1F, 0xC0, /* 0x32 two */ + 0x7B, 0x30, 0xCE, 0x0F, 0x37, 0x80, /* 0x33 three */ + 0x1C, 0x79, 0xB6, 0x6F, 0xE1, 0x87, 0x80, /* 0x34 four */ + 0xFF, 0x0F, 0x83, 0x0F, 0x37, 0x80, /* 0x35 five */ + 0x39, 0x8C, 0x3E, 0xCF, 0x37, 0x80, /* 0x36 six */ + 0xFF, 0x30, 0xC6, 0x30, 0xC3, 0x00, /* 0x37 seven */ + 0x7B, 0x3C, 0xDE, 0xCF, 0x37, 0x80, /* 0x38 eight */ + 0x7B, 0x3C, 0xDF, 0x0C, 0x67, 0x00, /* 0x39 nine */ + 0xF0, 0xF0, /* 0x3A colon */ + 0x6C, 0x37, 0x80, /* 0x3B semicolon */ + 0x19, 0x99, 0x86, 0x18, 0x60, /* 0x3C less */ + 0xFC, 0x00, 0x3F, /* 0x3D equal */ + 0xC3, 0x0C, 0x33, 0x33, 0x00, /* 0x3E greater */ + 0x7B, 0x30, 0xC6, 0x30, 0x03, 0x00, /* 0x3F question */ + 0x7D, 0x8F, 0x7E, 0xFD, 0xF8, 0x1E, 0x00, /* 0x40 at */ + 0x31, 0xEC, 0xF3, 0xFF, 0x3C, 0xC0, /* 0x41 A */ + 0xFC, 0xCD, 0x9B, 0xE6, 0x6C, 0xFF, 0x00, /* 0x42 B */ + 0x3C, 0xCF, 0x06, 0x0C, 0x0C, 0xCF, 0x00, /* 0x43 C */ + 0xF8, 0xD9, 0x9B, 0x36, 0x6D, 0xBE, 0x00, /* 0x44 D */ + 0xFE, 0xC5, 0xA3, 0xC6, 0x8C, 0x7F, 0x80, /* 0x45 E */ + 0xFE, 0xC5, 0xA3, 0xC6, 0x8C, 0x3C, 0x00, /* 0x46 F */ + 0x3C, 0xCF, 0x06, 0x0C, 0xEC, 0xCF, 0x80, /* 0x47 G */ + 0xCF, 0x3C, 0xFF, 0xCF, 0x3C, 0xC0, /* 0x48 H */ + 0xF6, 0x66, 0x66, 0xF0, /* 0x49 I */ + 0x1E, 0x18, 0x30, 0x6C, 0xD9, 0x9E, 0x00, /* 0x4A J */ + 0xE6, 0xCD, 0xB3, 0xC6, 0xCC, 0xF9, 0x80, /* 0x4B K */ + 0xF0, 0xC1, 0x83, 0x06, 0x2C, 0xFF, 0x80, /* 0x4C L */ + 0xC7, 0xDF, 0xFF, 0xFD, 0x78, 0xF1, 0x80, /* 0x4D M */ + 0xC7, 0xCF, 0xDE, 0xFC, 0xF8, 0xF1, 0x80, /* 0x4E N */ + 0x38, 0xDB, 0x1E, 0x3C, 0x6D, 0x8E, 0x00, /* 0x4F O */ + 0xFC, 0xCD, 0x9B, 0xE6, 0x0C, 0x3C, 0x00, /* 0x50 P */ + 0x7B, 0x3C, 0xF3, 0xDD, 0xE1, 0xC0, /* 0x51 Q */ + 0xFC, 0xCD, 0x9B, 0xE6, 0xCC, 0xF9, 0x80, /* 0x52 R */ + 0x7B, 0x3E, 0x1C, 0x1F, 0x37, 0x80, /* 0x53 S */ + 0xFE, 0xD3, 0x0C, 0x30, 0xC7, 0x80, /* 0x54 T */ + 0xCF, 0x3C, 0xF3, 0xCF, 0x3F, 0xC0, /* 0x55 U */ + 0xCF, 0x3C, 0xF3, 0xCD, 0xE3, 0x00, /* 0x56 V */ + 0xC7, 0x8F, 0x1E, 0xBF, 0xFD, 0xF1, 0x80, /* 0x57 W */ + 0xC7, 0x8D, 0xB1, 0xC3, 0x8D, 0xB1, 0x80, /* 0x58 X */ + 0xCF, 0x3C, 0xDE, 0x30, 0xC7, 0x80, /* 0x59 Y */ + 0xFF, 0x8E, 0x30, 0xC3, 0x2C, 0xFF, 0x80, /* 0x5A Z */ + 0xFC, 0xCC, 0xCC, 0xF0, /* 0x5B bracketleft */ + 0xC0, 0xC0, 0xC0, 0xC0, 0xC0, 0xC0, 0x80, /* 0x5C backslash */ + 0xF3, 0x33, 0x33, 0xF0, /* 0x5D bracketright */ + 0x10, 0x71, 0xB6, 0x30, /* 0x5E asciicircum */ + 0xFF, /* 0x5F underscore */ + 0xD9, 0x80, /* 0x60 grave */ + 0x78, 0x19, 0xF6, 0x67, 0x60, /* 0x61 a */ + 0xE0, 0xC1, 0x83, 0xE6, 0x6C, 0xF7, 0x00, /* 0x62 b */ + 0x7B, 0x3C, 0x33, 0x78, /* 0x63 c */ + 0x1C, 0x18, 0x33, 0xEC, 0xD9, 0x9D, 0x80, /* 0x64 d */ + 0x7B, 0x3F, 0xF0, 0x78, /* 0x65 e */ + 0x39, 0xB6, 0x3C, 0x61, 0x8F, 0x00, /* 0x66 f */ + 0x77, 0x9B, 0x33, 0xE0, 0xDF, 0x00, /* 0x67 g */ + 0xE0, 0xC1, 0xB3, 0xB6, 0x6C, 0xF9, 0x80, /* 0x68 h */ + 0x60, 0xE6, 0x66, 0xF0, /* 0x69 i */ + 0x0C, 0x00, 0xC3, 0x0F, 0x3C, 0xDE, /* 0x6A j */ + 0xE0, 0xC1, 0x9B, 0x67, 0x8D, 0xB9, 0x80, /* 0x6B k */ + 0xE6, 0x66, 0x66, 0xF0, /* 0x6C l */ + 0xCD, 0xFF, 0xFE, 0xBC, 0x60, /* 0x6D m */ + 0xFB, 0x3C, 0xF3, 0xCC, /* 0x6E n */ + 0x7B, 0x3C, 0xF3, 0x78, /* 0x6F o */ + 0xDC, 0xCD, 0x9B, 0xE6, 0x1E, 0x00, /* 0x70 p */ + 0x77, 0x9B, 0x33, 0xE0, 0xC3, 0xC0, /* 0x71 q */ + 0xDC, 0xED, 0x9B, 0x0F, 0x00, /* 0x72 r */ + 0x7F, 0x07, 0x83, 0xF8, /* 0x73 s */ + 0x23, 0x3E, 0xC6, 0x34, 0xC0, /* 0x74 t */ + 0xCD, 0x9B, 0x36, 0x67, 0x60, /* 0x75 u */ + 0xCF, 0x3C, 0xDE, 0x30, /* 0x76 v */ + 0xC7, 0xAF, 0xFF, 0xF6, 0xC0, /* 0x77 w */ + 0xC6, 0xD8, 0xE3, 0x6C, 0x60, /* 0x78 x */ + 0xCF, 0x3C, 0xDF, 0x0F, 0xE0, /* 0x79 y */ + 0xFE, 0x63, 0x19, 0xFC, /* 0x7A z */ + 0x1C, 0xC3, 0x38, 0x30, 0xC1, 0xC0, /* 0x7B braceleft */ + 0xFC, 0xFC, /* 0x7C bar */ + 0xE0, 0xC3, 0x07, 0x30, 0xCE, 0x00, /* 0x7D braceright */ + 0x77, 0xB8, /* 0x7E asciitilde */ + 0x10, 0x71, 0xB6, 0x3C, 0x7F, 0xC0 /* 0x7F uni007F */ +}; + +const GFXglyph IBM8x8pxGlyphs[] PROGMEM = { + { 0, 1, 1, 2, 0, -1 }, /* 0x20 space */ + { 1, 4, 7, 5, 0, -7 }, /* 0x21 exclam */ + { 5, 5, 3, 6, 0, -7 }, /* 0x22 quotedbl */ + { 7, 7, 7, 8, 0, -7 }, /* 0x23 numbersign */ + { 14, 6, 7, 7, 0, -7 }, /* 0x24 dollar */ + { 20, 7, 6, 8, 0, -6 }, /* 0x25 percent */ + { 26, 7, 7, 8, 0, -7 }, /* 0x26 ampersand */ + { 33, 3, 3, 4, 0, -7 }, /* 0x27 quotesingle */ + { 35, 4, 7, 5, 0, -7 }, /* 0x28 parenleft */ + { 39, 4, 7, 5, 0, -7 }, /* 0x29 parenright */ + { 43, 8, 5, 9, 0, -6 }, /* 0x2A asterisk */ + { 48, 6, 5, 7, 0, -6 }, /* 0x2B plus */ + { 52, 3, 3, 4, 0, -2 }, /* 0x2C comma */ + { 54, 6, 1, 7, 0, -4 }, /* 0x2D hyphen */ + { 55, 2, 2, 3, 0, -2 }, /* 0x2E period */ + { 56, 7, 7, 8, 0, -7 }, /* 0x2F slash */ + { 63, 7, 7, 8, 0, -7 }, /* 0x30 zero */ + { 70, 6, 7, 7, 0, -7 }, /* 0x31 one */ + { 76, 6, 7, 7, 0, -7 }, /* 0x32 two */ + { 82, 6, 7, 7, 0, -7 }, /* 0x33 three */ + { 88, 7, 7, 8, 0, -7 }, /* 0x34 four */ + { 95, 6, 7, 7, 0, -7 }, /* 0x35 five */ + { 101, 6, 7, 7, 0, -7 }, /* 0x36 six */ + { 107, 6, 7, 7, 0, -7 }, /* 0x37 seven */ + { 113, 6, 7, 7, 0, -7 }, /* 0x38 eight */ + { 119, 6, 7, 7, 0, -7 }, /* 0x39 nine */ + { 125, 2, 6, 3, 0, -6 }, /* 0x3A colon */ + { 127, 3, 6, 4, 0, -6 }, /* 0x3B semicolon */ + { 130, 5, 7, 6, 0, -7 }, /* 0x3C less */ + { 135, 6, 4, 7, 0, -5 }, /* 0x3D equal */ + { 138, 5, 7, 6, 0, -7 }, /* 0x3E greater */ + { 143, 6, 7, 7, 0, -7 }, /* 0x3F question */ + { 149, 7, 7, 8, 0, -7 }, /* 0x40 at */ + { 156, 6, 7, 7, 0, -7 }, /* 0x41 A */ + { 162, 7, 7, 8, 0, -7 }, /* 0x42 B */ + { 169, 7, 7, 8, 0, -7 }, /* 0x43 C */ + { 176, 7, 7, 8, 0, -7 }, /* 0x44 D */ + { 183, 7, 7, 8, 0, -7 }, /* 0x45 E */ + { 190, 7, 7, 8, 0, -7 }, /* 0x46 F */ + { 197, 7, 7, 8, 0, -7 }, /* 0x47 G */ + { 204, 6, 7, 7, 0, -7 }, /* 0x48 H */ + { 210, 4, 7, 5, 0, -7 }, /* 0x49 I */ + { 214, 7, 7, 8, 0, -7 }, /* 0x4A J */ + { 221, 7, 7, 8, 0, -7 }, /* 0x4B K */ + { 228, 7, 7, 8, 0, -7 }, /* 0x4C L */ + { 235, 7, 7, 8, 0, -7 }, /* 0x4D M */ + { 242, 7, 7, 8, 0, -7 }, /* 0x4E N */ + { 249, 7, 7, 8, 0, -7 }, /* 0x4F O */ + { 256, 7, 7, 8, 0, -7 }, /* 0x50 P */ + { 263, 6, 7, 7, 0, -7 }, /* 0x51 Q */ + { 269, 7, 7, 8, 0, -7 }, /* 0x52 R */ + { 276, 6, 7, 7, 0, -7 }, /* 0x53 S */ + { 282, 6, 7, 7, 0, -7 }, /* 0x54 T */ + { 288, 6, 7, 7, 0, -7 }, /* 0x55 U */ + { 294, 6, 7, 7, 0, -7 }, /* 0x56 V */ + { 300, 7, 7, 8, 0, -7 }, /* 0x57 W */ + { 307, 7, 7, 8, 0, -7 }, /* 0x58 X */ + { 314, 6, 7, 7, 0, -7 }, /* 0x59 Y */ + { 320, 7, 7, 8, 0, -7 }, /* 0x5A Z */ + { 327, 4, 7, 5, 0, -7 }, /* 0x5B bracketleft */ + { 331, 7, 7, 8, 0, -7 }, /* 0x5C backslash */ + { 338, 4, 7, 5, 0, -7 }, /* 0x5D bracketright */ + { 342, 7, 4, 8, 0, -7 }, /* 0x5E asciicircum */ + { 346, 8, 1, 9, 0, 0 }, /* 0x5F underscore */ + { 347, 3, 3, 4, 0, -7 }, /* 0x60 grave */ + { 349, 7, 5, 8, 0, -5 }, /* 0x61 a */ + { 354, 7, 7, 8, 0, -7 }, /* 0x62 b */ + { 361, 6, 5, 7, 0, -5 }, /* 0x63 c */ + { 365, 7, 7, 8, 0, -7 }, /* 0x64 d */ + { 372, 6, 5, 7, 0, -5 }, /* 0x65 e */ + { 376, 6, 7, 7, 0, -7 }, /* 0x66 f */ + { 382, 7, 6, 8, 0, -5 }, /* 0x67 g */ + { 388, 7, 7, 8, 0, -7 }, /* 0x68 h */ + { 395, 4, 7, 5, 0, -7 }, /* 0x69 i */ + { 399, 6, 8, 7, 0, -7 }, /* 0x6A j */ + { 405, 7, 7, 8, 0, -7 }, /* 0x6B k */ + { 412, 4, 7, 5, 0, -7 }, /* 0x6C l */ + { 416, 7, 5, 8, 0, -5 }, /* 0x6D m */ + { 421, 6, 5, 7, 0, -5 }, /* 0x6E n */ + { 425, 6, 5, 7, 0, -5 }, /* 0x6F o */ + { 429, 7, 6, 8, 0, -5 }, /* 0x70 p */ + { 435, 7, 6, 8, 0, -5 }, /* 0x71 q */ + { 441, 7, 5, 8, 0, -5 }, /* 0x72 r */ + { 446, 6, 5, 7, 0, -5 }, /* 0x73 s */ + { 450, 5, 7, 6, 0, -7 }, /* 0x74 t */ + { 455, 7, 5, 8, 0, -5 }, /* 0x75 u */ + { 460, 6, 5, 7, 0, -5 }, /* 0x76 v */ + { 464, 7, 5, 8, 0, -5 }, /* 0x77 w */ + { 469, 7, 5, 8, 0, -5 }, /* 0x78 x */ + { 474, 6, 6, 7, 0, -5 }, /* 0x79 y */ + { 479, 6, 5, 7, 0, -5 }, /* 0x7A z */ + { 483, 6, 7, 7, 0, -7 }, /* 0x7B braceleft */ + { 489, 2, 7, 3, 0, -7 }, /* 0x7C bar */ + { 491, 6, 7, 7, 0, -7 }, /* 0x7D braceright */ + { 497, 7, 2, 8, 0, -7 }, /* 0x7E asciitilde */ + { 499, 7, 6, 8, 0, -6 } /* 0x7F uni007F */ +}; + +const GFXfont IBM8x8px PROGMEM = { + (uint8_t *)IBM8x8pxBitmaps, + (GFXglyph *)IBM8x8pxGlyphs, + 0x20, 0x7F, 8 }; diff --git a/lib/obp60task/gen_set.py b/lib/obp60task/gen_set.py index 311929e..ac64f59 100755 --- a/lib/obp60task/gen_set.py +++ b/lib/obp60task/gen_set.py @@ -20,7 +20,7 @@ import getopt import re import json -__version__ = "1.2" +__version__ = "1.3" def detect_pages(filename): # returns a dictionary with page name and the number of gui fields @@ -87,6 +87,11 @@ def create_json(device, no_of_pages, pagedata): output = [] for page_no in range(1, no_of_pages + 1): + + category = f"{device.upper()} Page {page_no}" + capabilities = {device.lower(): "true"} + visiblepages = [vp for vp in range(page_no, no_of_pages + 1)] + page_data = { "name": f"page{page_no}type", "label": "Type", @@ -94,9 +99,11 @@ def create_json(device, no_of_pages, pagedata): "default": get_default_page(page_no), "description": f"Type of page for page {page_no}", "list": pages, - "category": f"{device.upper()} Page {page_no}", + "category": category, "capabilities": {device.lower(): "true"}, - "condition": [{"visiblePages": vp} for vp in range(page_no, no_of_pages + 1)], + "condition": { + "visiblePages": visiblepages + }, #"fields": [], } output.append(page_data) @@ -108,38 +115,56 @@ def create_json(device, no_of_pages, pagedata): "type": "boatData", "default": "", "description": "The display for field {}".format(number_to_text(field_no)), - "category": f"{device.upper()} Page {page_no}", - "capabilities": {device.lower(): "true"}, + "category": category, + "capabilities": capabilities, "condition": { f"page{page_no}type": [page for page in pages if pagedata[page] >= field_no], - "visiblePages": [vp for vp in range(page_no, no_of_pages + 1)] - }, + "visiblePages": visiblepages + } } output.append(field_data) - fluid_data ={ + fluid_data = { "name": f"page{page_no}fluid", "label": "Fluid type", "type": "list", "default": "0", "list": [ - {"l":"Fuel (0)","v":"0"}, - {"l":"Water (1)","v":"1"}, - {"l":"Gray Water (2)","v":"2"}, - {"l":"Live Well (3)","v":"3"}, - {"l":"Oil (4)","v":"4"}, - {"l":"Black Water (5)","v":"5"}, - {"l":"Fuel Gasoline (6)","v":"6"} + {"l":"Fuel (0)","v":"0"}, + {"l":"Water (1)","v":"1"}, + {"l":"Gray Water (2)","v":"2"}, + {"l":"Live Well (3)","v":"3"}, + {"l":"Oil (4)","v":"4"}, + {"l":"Black Water (5)","v":"5"}, + {"l":"Fuel Gasoline (6)","v":"6"} ], "description": "Fluid type in tank", - "category": f"{device.upper()} Page {page_no}", - "capabilities": { - device.lower(): "true" - }, + "category": category, + "capabilities": capabilities, "condition":[{f"page{page_no}type":"Fluid"}] - } + } output.append(fluid_data) + if device.upper() == 'OBP40': + windsource = { + "name": f"page{page_no}wndsrc", + "label": "Wind source", + "type": "list", + "default": "True wind", + "description": f"Wind source for page {page_no}: [true|apparent]", + "list": [ + "True wind", + "Apparent wind" + ], + "category": category, + "capabilities": capabilities, + "condition": { + f"page{page_no}type": "WindPlot", + "visiblePages": visiblepages + } + } + output.append(windsource) + return json.dumps(output, indent=4) def usage(): diff --git a/lib/obp60task/images/foxtrot.xbm b/lib/obp60task/images/foxtrot.xbm new file mode 100644 index 0000000..a884ba4 --- /dev/null +++ b/lib/obp60task/images/foxtrot.xbm @@ -0,0 +1,67 @@ +#define foxtrot_width 96 +#define foxtrot_height 64 +static unsigned char foxtrot_bits[] = { + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0xa8, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x54, 0x15, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0xaa, 0xaa, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x55, 0x55, 0x01, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0xa0, 0xaa, 0xaa, 0x02, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x50, 0x55, 0x55, 0x05, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0xa8, 0xaa, 0xaa, 0x2a, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x54, 0x55, 0x55, 0x55, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x80, 0xaa, 0xaa, 0xaa, 0xaa, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x40, 0x55, 0x55, 0x55, 0x55, 0x01, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0xa0, 0xaa, 0xaa, 0xaa, 0xaa, 0x0a, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x50, 0x55, 0x55, 0x55, 0x55, 0x15, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x2a, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x80, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x02, 0x00, 0x00, + 0x00, 0x00, 0x40, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x05, 0x00, 0x00, + 0x00, 0x00, 0xa8, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x0a, 0x00, 0x00, + 0x00, 0x00, 0x54, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x15, 0x00, 0x00, + 0x00, 0x00, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x00, 0x00, + 0x00, 0x00, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x01, 0x00, + 0x00, 0xa0, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x02, 0x00, + 0x00, 0x50, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x05, 0x00, + 0x00, 0xa8, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x2a, 0x00, + 0x00, 0x54, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x00, + 0x80, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x00, + 0x40, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x01, + 0xa0, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x0a, + 0x50, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x15, + 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x2a, + 0x54, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, + 0xa8, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x0a, + 0x50, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x05, + 0x80, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x02, + 0x00, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x01, + 0x00, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x2a, 0x00, + 0x00, 0x54, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x15, 0x00, + 0x00, 0xa0, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x0a, 0x00, + 0x00, 0x40, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x05, 0x00, + 0x00, 0x80, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x00, 0x00, + 0x00, 0x00, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x00, 0x00, + 0x00, 0x00, 0xa8, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x2a, 0x00, 0x00, + 0x00, 0x00, 0x50, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x15, 0x00, 0x00, + 0x00, 0x00, 0xa0, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x02, 0x00, 0x00, + 0x00, 0x00, 0x40, 0x55, 0x55, 0x55, 0x55, 0x55, 0x55, 0x01, 0x00, 0x00, + 0x00, 0x00, 0x00, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x54, 0x55, 0x55, 0x55, 0x55, 0x55, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0xa8, 0xaa, 0xaa, 0xaa, 0xaa, 0x0a, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x50, 0x55, 0x55, 0x55, 0x55, 0x05, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x80, 0xaa, 0xaa, 0xaa, 0xaa, 0x02, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x55, 0x55, 0x55, 0x55, 0x01, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0xaa, 0xaa, 0xaa, 0x2a, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x54, 0x55, 0x55, 0x15, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0xa0, 0xaa, 0xaa, 0x0a, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x40, 0x55, 0x55, 0x05, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x80, 0xaa, 0xaa, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x55, 0x55, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0xa8, 0x2a, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x50, 0x15, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0xa0, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; diff --git a/lib/obp60task/obp60task.cpp b/lib/obp60task/obp60task.cpp index 74a8965..98cbc8d 100644 --- a/lib/obp60task/obp60task.cpp +++ b/lib/obp60task/obp60task.cpp @@ -14,7 +14,6 @@ #include // GxEPD2 lib for b/w E-Ink displays #include "OBP60Extensions.h" // Functions lib for extension board #include "OBPKeyboardTask.h" // Functions lib for keyboard handling -#include "BoatDataCalibration.h" // Functions lib for data instance calibration #include "OBPDataOperations.h" // Functions lib for data operations such as true wind calculation #include "OBP60QRWiFi.h" // Functions lib for WiFi QR code #include "OBPSensorTask.h" // Functions lib for sensor data @@ -253,6 +252,10 @@ void registerAllPages(GwLog *logger, PageList &list){ list.add(®isterPageFluid); extern PageDescription registerPageSkyView; list.add(®isterPageSkyView); + extern PageDescription registerPageNavigation; + list.add(®isterPageNavigation); + extern PageDescription registerPageDigitalOut; + list.add(®isterPageDigitalOut); extern PageDescription registerPageAnchor; list.add(®isterPageAnchor); extern PageDescription registerPageAIS; @@ -432,13 +435,12 @@ void OBP60Task(GwApi *api){ #endif LOG_DEBUG(GwLog::LOG,"...done"); - int lastPage=pageNumber; + int lastPage=-1; // initialize with an impossible value, so we can detect wether we are during startup and no page has been displayed yet BoatValueList boatValues; //all the boat values for the api query - HstryBuf hstryBufList(960); // Create ring buffers for history storage of some boat data - WindUtils trueWind(&boatValues); // Create helper object for true wind calculation - //commonData.distanceformat=config->getString(xxx); - //add all necessary data to common data + HstryBuffers hstryBufferList(1920, &boatValues, logger); // Create empty list of boat data history buffers (1.920 values = seconds = 32 min.) + WindUtils trueWind(&boatValues, logger); // Create helper object for true wind calculation + CalibrationData calibrationDataList(logger); // all boat data types which are supposed to be calibrated //fill the page data from config numPages=config->getInt(config->visiblePages,1); @@ -479,21 +481,26 @@ void OBP60Task(GwApi *api){ LOG_DEBUG(GwLog::DEBUG,"added fixed value %s to page %d",value->getName().c_str(),i); pages[i].parameters.values.push_back(value); } - // Add boat history data to page parameters - pages[i].parameters.boatHstry = &hstryBufList; + + // Read the specified boat data types of relevant pages and create a history buffer for each type + if (pages[i].parameters.pageName == "OneValue" || pages[i].parameters.pageName == "TwoValues" || pages[i].parameters.pageName == "WindPlot") { + for (auto pVal : pages[i].parameters.values) { + hstryBufferList.addBuffer(pVal->getName()); + } + } + // Add list of history buffers to page parameters + pages[i].parameters.hstryBuffers = &hstryBufferList; + } + // add out of band system page (always available) Page *syspage = allPages.pages[0]->creator(commonData); - // Read all calibration data settings from config - calibrationData.readConfig(config, logger); - - // Check user settings for true wind calculation + // Read user settings from config file bool calcTrueWnds = api->getConfig()->getBool(api->getConfig()->calcTrueWnds, false); bool useSimuData = api->getConfig()->getBool(api->getConfig()->useSimuData, false); - - // Initialize history buffer for certain boat data - hstryBufList.init(&boatValues, logger); + // Read user calibration data settings from config file + calibrationDataList.readConfig(config); // Display screenshot handler for HTTP request // http://192.168.15.1/api/user/OBP60Task/screenshot @@ -654,7 +661,9 @@ void OBP60Task(GwApi *api){ // if(String(backlight) == "Control by Key"){ if(keyboardMessage == 6){ LOG_DEBUG(GwLog::LOG,"Toggle Backlight LED"); - toggleBacklightLED(commonData.backlight.brightness, commonData.backlight.color); + // TODO config: toogle vs steps + // toggleBacklightLED(commonData.backlight.brightness, commonData.backlight.color); + stepsBacklightLED(commonData.backlight.brightness, commonData.backlight.color); } } #ifdef BOARD_OBP40S3 @@ -716,8 +725,8 @@ void OBP60Task(GwApi *api){ } } - // Full display update afer a new selected page and 4s wait time - if(millis() > starttime4 + 4000 && delayedDisplayUpdate == true){ + // Full display update afer a new selected page and 8s wait time + if (millis() > starttime4 + 8000 && delayedDisplayUpdate == true) { starttime1 = millis(); starttime2 = millis(); epd->setFullWindow(); // Set full update @@ -807,10 +816,10 @@ void OBP60Task(GwApi *api){ api->getStatus(commonData.status); if (calcTrueWnds) { - trueWind.addTrueWind(api, &boatValues, logger); + trueWind.addWinds(); // calculate true wind data from apparent wind values } - // Handle history buffers for TWD, TWS for wind plot page and other usage - hstryBufList.handleHstryBuf(useSimuData); + calibrationDataList.handleCalibration(&boatValues); // Process calibration for all boat data in + hstryBufferList.handleHstryBufs(useSimuData, commonData); // Handle history buffers for certain boat data for windplot page and other usage // Clear display // epd->fillRect(0, 0, epd->width(), epd->height(), commonData.bgcolor); @@ -846,9 +855,11 @@ void OBP60Task(GwApi *api){ epd->nextPage(); // Partial update (fast) } else { - if (lastPage != pageNumber){ - pages[lastPage].page->leavePage(pages[lastPage].parameters); // call page cleanup code - if (hasFRAM) fram.write(FRAM_PAGE_NO, pageNumber); // remember new page for device restart + if (lastPage != pageNumber) { + if (lastPage != -1) { // skip cleanup if we are during startup, and no page has been displayed yet + pages[lastPage].page->leavePage(pages[lastPage].parameters); // call page cleanup code + if (hasFRAM) fram.write(FRAM_PAGE_NO, pageNumber); // remember new page for device restart + } currentPage->setupKeys(); currentPage->displayNew(pages[pageNumber].parameters); lastPage = pageNumber; diff --git a/lib/obp60task/platformio.ini b/lib/obp60task/platformio.ini index cc1a6f1..f8528e9 100644 --- a/lib/obp60task/platformio.ini +++ b/lib/obp60task/platformio.ini @@ -15,6 +15,8 @@ board_build.variants_dir = variants board = obp60_s3_n16r8 #ESP32-S3 N16R8, 16MB flash, 8MB PSRAM, production series #board_build.partitions = default_8MB.csv #ESP32-S3 N8, 8MB flash board_build.partitions = default_16MB.csv #ESP32-S3 N16, 16MB flash +custom_config = lib/obp60task/config_obp60.json +custom_script = lib/obp60task/extra_task.py board_name = OBP60 framework = arduino lib_deps = @@ -22,6 +24,8 @@ lib_deps = Wire SPI ESP32time + HTTPClient + WiFiClientSecure robtillaart/PCF8574@0.3.9 adafruit/Adafruit Unified Sensor @ 1.1.13 blemasle/MCP23017@2.0.0 @@ -51,8 +55,6 @@ build_flags= # -D DISPLAY_GYE042A87 #alternativ E-Ink display from Genyo Optical, R10 2.2 ohm - medium # -D DISPLAY_SE0420NQ04 #alternativ E-Ink display from SID Technology, R10 2.2 ohm - bad (burn in effects) # -D DISPLAY_ZJY400300-042CAAMFGN #alternativ E-Ink display from ZZE Technology, R10 2.2 ohm - very good -# -D ENABLE_TRUEWIND # calculate true wind data (default off) -# -D ENABLE_CALIBRATION # boat data calibration (default off) ${env.build_flags} #CONFIG_ESP_TASK_WDT_TIMEOUT_S = 10 #Task Watchdog timeout period (seconds) [1...60] 5 default upload_port = /dev/ttyACM0 #OBP60 download via USB-C direct @@ -64,14 +66,17 @@ monitor_speed = 115200 board_build.variants_dir = variants board = obp40_s3_n8r8 #ESP32-S3 N8R8, 8MB flash, 8MB PSRAM, OBP60 clone (CrowPanel 4.2) board_build.partitions = default_8MB.csv #ESP32-S3 N8, 8MB flash +custom_config = lib/obp60task/config_obp40.json +custom_script = lib/obp60task/extra_task.py board_name = OBP40 -custom_config = config_obp40.json framework = arduino lib_deps = ${basedeps.lib_deps} Wire SPI ESP32time + HTTPClient + WiFiClientSecure robtillaart/PCF8574@0.3.9 adafruit/Adafruit Unified Sensor @ 1.1.13 blemasle/MCP23017@2.0.0 @@ -96,8 +101,6 @@ build_flags= #-D DISPLAY_ZJY400300-042CAAMFGN #alternativ E-Ink display from ZZE Technology, R10 2.2 ohm - very good # -D LIPO_ACCU_1200 #Hardware extension, LiPo accu 3,7V 1200mAh # -D VOLTAGE_SENSOR #Hardware extension, LiPo voltage sensor with two resistors -# -D ENABLE_TRUEWIND # calculate true wind data (default off) -# -D ENABLE_CALIBRATION # boat data calibration (default off) ${env.build_flags} upload_port = /dev/ttyUSB0 #OBP40 download via external USB/Serail converter upload_protocol = esptool #firmware upload via USB OTG seriell, by first upload need to set the ESP32-S3 in the upload mode with shortcut GND to Pin27 diff --git a/lib/obp60task/puff.c b/lib/obp60task/puff.c new file mode 100644 index 0000000..d759825 --- /dev/null +++ b/lib/obp60task/puff.c @@ -0,0 +1,840 @@ +/* + * puff.c + * Copyright (C) 2002-2013 Mark Adler + * For conditions of distribution and use, see copyright notice in puff.h + * version 2.3, 21 Jan 2013 + * + * puff.c is a simple inflate written to be an unambiguous way to specify the + * deflate format. It is not written for speed but rather simplicity. As a + * side benefit, this code might actually be useful when small code is more + * important than speed, such as bootstrap applications. For typical deflate + * data, zlib's inflate() is about four times as fast as puff(). zlib's + * inflate compiles to around 20K on my machine, whereas puff.c compiles to + * around 4K on my machine (a PowerPC using GNU cc). If the faster decode() + * function here is used, then puff() is only twice as slow as zlib's + * inflate(). + * + * All dynamically allocated memory comes from the stack. The stack required + * is less than 2K bytes. This code is compatible with 16-bit int's and + * assumes that long's are at least 32 bits. puff.c uses the short data type, + * assumed to be 16 bits, for arrays in order to conserve memory. The code + * works whether integers are stored big endian or little endian. + * + * In the comments below are "Format notes" that describe the inflate process + * and document some of the less obvious aspects of the format. This source + * code is meant to supplement RFC 1951, which formally describes the deflate + * format: + * + * http://www.zlib.org/rfc-deflate.html + */ + +/* + * Change history: + * + * 1.0 10 Feb 2002 - First version + * 1.1 17 Feb 2002 - Clarifications of some comments and notes + * - Update puff() dest and source pointers on negative + * errors to facilitate debugging deflators + * - Remove longest from struct huffman -- not needed + * - Simplify offs[] index in construct() + * - Add input size and checking, using longjmp() to + * maintain easy readability + * - Use short data type for large arrays + * - Use pointers instead of long to specify source and + * destination sizes to avoid arbitrary 4 GB limits + * 1.2 17 Mar 2002 - Add faster version of decode(), doubles speed (!), + * but leave simple version for readability + * - Make sure invalid distances detected if pointers + * are 16 bits + * - Fix fixed codes table error + * - Provide a scanning mode for determining size of + * uncompressed data + * 1.3 20 Mar 2002 - Go back to lengths for puff() parameters [Gailly] + * - Add a puff.h file for the interface + * - Add braces in puff() for else do [Gailly] + * - Use indexes instead of pointers for readability + * 1.4 31 Mar 2002 - Simplify construct() code set check + * - Fix some comments + * - Add FIXLCODES #define + * 1.5 6 Apr 2002 - Minor comment fixes + * 1.6 7 Aug 2002 - Minor format changes + * 1.7 3 Mar 2003 - Added test code for distribution + * - Added zlib-like license + * 1.8 9 Jan 2004 - Added some comments on no distance codes case + * 1.9 21 Feb 2008 - Fix bug on 16-bit integer architectures [Pohland] + * - Catch missing end-of-block symbol error + * 2.0 25 Jul 2008 - Add #define to permit distance too far back + * - Add option in TEST code for puff to write the data + * - Add option in TEST code to skip input bytes + * - Allow TEST code to read from piped stdin + * 2.1 4 Apr 2010 - Avoid variable initialization for happier compilers + * - Avoid unsigned comparisons for even happier compilers + * 2.2 25 Apr 2010 - Fix bug in variable initializations [Oberhumer] + * - Add const where appropriate [Oberhumer] + * - Split if's and ?'s for coverage testing + * - Break out test code to separate file + * - Move NIL to puff.h + * - Allow incomplete code only if single code length is 1 + * - Add full code coverage test to Makefile + * 2.3 21 Jan 2013 - Check for invalid code length codes in dynamic blocks + */ + +#include /* for setjmp(), longjmp(), and jmp_buf */ +#include "puff.h" /* prototype for puff() */ + +#define local static /* for local function definitions */ + +/* + * Maximums for allocations and loops. It is not useful to change these -- + * they are fixed by the deflate format. + */ +#define MAXBITS 15 /* maximum bits in a code */ +#define MAXLCODES 286 /* maximum number of literal/length codes */ +#define MAXDCODES 30 /* maximum number of distance codes */ +#define MAXCODES (MAXLCODES+MAXDCODES) /* maximum codes lengths to read */ +#define FIXLCODES 288 /* number of fixed literal/length codes */ + +/* input and output state */ +struct state { + /* output state */ + unsigned char *out; /* output buffer */ + unsigned long outlen; /* available space at out */ + unsigned long outcnt; /* bytes written to out so far */ + + /* input state */ + const unsigned char *in; /* input buffer */ + unsigned long inlen; /* available input at in */ + unsigned long incnt; /* bytes read so far */ + int bitbuf; /* bit buffer */ + int bitcnt; /* number of bits in bit buffer */ + + /* input limit error return state for bits() and decode() */ + jmp_buf env; +}; + +/* + * Return need bits from the input stream. This always leaves less than + * eight bits in the buffer. bits() works properly for need == 0. + * + * Format notes: + * + * - Bits are stored in bytes from the least significant bit to the most + * significant bit. Therefore bits are dropped from the bottom of the bit + * buffer, using shift right, and new bytes are appended to the top of the + * bit buffer, using shift left. + */ +local int bits(struct state *s, int need) +{ + long val; /* bit accumulator (can use up to 20 bits) */ + + /* load at least need bits into val */ + val = s->bitbuf; + while (s->bitcnt < need) { + if (s->incnt == s->inlen) + longjmp(s->env, 1); /* out of input */ + val |= (long)(s->in[s->incnt++]) << s->bitcnt; /* load eight bits */ + s->bitcnt += 8; + } + + /* drop need bits and update buffer, always zero to seven bits left */ + s->bitbuf = (int)(val >> need); + s->bitcnt -= need; + + /* return need bits, zeroing the bits above that */ + return (int)(val & ((1L << need) - 1)); +} + +/* + * Process a stored block. + * + * Format notes: + * + * - After the two-bit stored block type (00), the stored block length and + * stored bytes are byte-aligned for fast copying. Therefore any leftover + * bits in the byte that has the last bit of the type, as many as seven, are + * discarded. The value of the discarded bits are not defined and should not + * be checked against any expectation. + * + * - The second inverted copy of the stored block length does not have to be + * checked, but it's probably a good idea to do so anyway. + * + * - A stored block can have zero length. This is sometimes used to byte-align + * subsets of the compressed data for random access or partial recovery. + */ +local int stored(struct state *s) +{ + unsigned len; /* length of stored block */ + + /* discard leftover bits from current byte (assumes s->bitcnt < 8) */ + s->bitbuf = 0; + s->bitcnt = 0; + + /* get length and check against its one's complement */ + if (s->incnt + 4 > s->inlen) + return 2; /* not enough input */ + len = s->in[s->incnt++]; + len |= s->in[s->incnt++] << 8; + if (s->in[s->incnt++] != (~len & 0xff) || + s->in[s->incnt++] != ((~len >> 8) & 0xff)) + return -2; /* didn't match complement! */ + + /* copy len bytes from in to out */ + if (s->incnt + len > s->inlen) + return 2; /* not enough input */ + if (s->out != NIL) { + if (s->outcnt + len > s->outlen) + return 1; /* not enough output space */ + while (len--) + s->out[s->outcnt++] = s->in[s->incnt++]; + } + else { /* just scanning */ + s->outcnt += len; + s->incnt += len; + } + + /* done with a valid stored block */ + return 0; +} + +/* + * Huffman code decoding tables. count[1..MAXBITS] is the number of symbols of + * each length, which for a canonical code are stepped through in order. + * symbol[] are the symbol values in canonical order, where the number of + * entries is the sum of the counts in count[]. The decoding process can be + * seen in the function decode() below. + */ +struct huffman { + short *count; /* number of symbols of each length */ + short *symbol; /* canonically ordered symbols */ +}; + +/* + * Decode a code from the stream s using huffman table h. Return the symbol or + * a negative value if there is an error. If all of the lengths are zero, i.e. + * an empty code, or if the code is incomplete and an invalid code is received, + * then -10 is returned after reading MAXBITS bits. + * + * Format notes: + * + * - The codes as stored in the compressed data are bit-reversed relative to + * a simple integer ordering of codes of the same lengths. Hence below the + * bits are pulled from the compressed data one at a time and used to + * build the code value reversed from what is in the stream in order to + * permit simple integer comparisons for decoding. A table-based decoding + * scheme (as used in zlib) does not need to do this reversal. + * + * - The first code for the shortest length is all zeros. Subsequent codes of + * the same length are simply integer increments of the previous code. When + * moving up a length, a zero bit is appended to the code. For a complete + * code, the last code of the longest length will be all ones. + * + * - Incomplete codes are handled by this decoder, since they are permitted + * in the deflate format. See the format notes for fixed() and dynamic(). + */ +#ifdef SLOW +local int decode(struct state *s, const struct huffman *h) +{ + int len; /* current number of bits in code */ + int code; /* len bits being decoded */ + int first; /* first code of length len */ + int count; /* number of codes of length len */ + int index; /* index of first code of length len in symbol table */ + + code = first = index = 0; + for (len = 1; len <= MAXBITS; len++) { + code |= bits(s, 1); /* get next bit */ + count = h->count[len]; + if (code - count < first) /* if length len, return symbol */ + return h->symbol[index + (code - first)]; + index += count; /* else update for next length */ + first += count; + first <<= 1; + code <<= 1; + } + return -10; /* ran out of codes */ +} + +/* + * A faster version of decode() for real applications of this code. It's not + * as readable, but it makes puff() twice as fast. And it only makes the code + * a few percent larger. + */ +#else /* !SLOW */ +local int decode(struct state *s, const struct huffman *h) +{ + int len; /* current number of bits in code */ + int code; /* len bits being decoded */ + int first; /* first code of length len */ + int count; /* number of codes of length len */ + int index; /* index of first code of length len in symbol table */ + int bitbuf; /* bits from stream */ + int left; /* bits left in next or left to process */ + short *next; /* next number of codes */ + + bitbuf = s->bitbuf; + left = s->bitcnt; + code = first = index = 0; + len = 1; + next = h->count + 1; + while (1) { + while (left--) { + code |= bitbuf & 1; + bitbuf >>= 1; + count = *next++; + if (code - count < first) { /* if length len, return symbol */ + s->bitbuf = bitbuf; + s->bitcnt = (s->bitcnt - len) & 7; + return h->symbol[index + (code - first)]; + } + index += count; /* else update for next length */ + first += count; + first <<= 1; + code <<= 1; + len++; + } + left = (MAXBITS+1) - len; + if (left == 0) + break; + if (s->incnt == s->inlen) + longjmp(s->env, 1); /* out of input */ + bitbuf = s->in[s->incnt++]; + if (left > 8) + left = 8; + } + return -10; /* ran out of codes */ +} +#endif /* SLOW */ + +/* + * Given the list of code lengths length[0..n-1] representing a canonical + * Huffman code for n symbols, construct the tables required to decode those + * codes. Those tables are the number of codes of each length, and the symbols + * sorted by length, retaining their original order within each length. The + * return value is zero for a complete code set, negative for an over- + * subscribed code set, and positive for an incomplete code set. The tables + * can be used if the return value is zero or positive, but they cannot be used + * if the return value is negative. If the return value is zero, it is not + * possible for decode() using that table to return an error--any stream of + * enough bits will resolve to a symbol. If the return value is positive, then + * it is possible for decode() using that table to return an error for received + * codes past the end of the incomplete lengths. + * + * Not used by decode(), but used for error checking, h->count[0] is the number + * of the n symbols not in the code. So n - h->count[0] is the number of + * codes. This is useful for checking for incomplete codes that have more than + * one symbol, which is an error in a dynamic block. + * + * Assumption: for all i in 0..n-1, 0 <= length[i] <= MAXBITS + * This is assured by the construction of the length arrays in dynamic() and + * fixed() and is not verified by construct(). + * + * Format notes: + * + * - Permitted and expected examples of incomplete codes are one of the fixed + * codes and any code with a single symbol which in deflate is coded as one + * bit instead of zero bits. See the format notes for fixed() and dynamic(). + * + * - Within a given code length, the symbols are kept in ascending order for + * the code bits definition. + */ +local int construct(struct huffman *h, const short *length, int n) +{ + int symbol; /* current symbol when stepping through length[] */ + int len; /* current length when stepping through h->count[] */ + int left; /* number of possible codes left of current length */ + short offs[MAXBITS+1]; /* offsets in symbol table for each length */ + + /* count number of codes of each length */ + for (len = 0; len <= MAXBITS; len++) + h->count[len] = 0; + for (symbol = 0; symbol < n; symbol++) + (h->count[length[symbol]])++; /* assumes lengths are within bounds */ + if (h->count[0] == n) /* no codes! */ + return 0; /* complete, but decode() will fail */ + + /* check for an over-subscribed or incomplete set of lengths */ + left = 1; /* one possible code of zero length */ + for (len = 1; len <= MAXBITS; len++) { + left <<= 1; /* one more bit, double codes left */ + left -= h->count[len]; /* deduct count from possible codes */ + if (left < 0) + return left; /* over-subscribed--return negative */ + } /* left > 0 means incomplete */ + + /* generate offsets into symbol table for each length for sorting */ + offs[1] = 0; + for (len = 1; len < MAXBITS; len++) + offs[len + 1] = offs[len] + h->count[len]; + + /* + * put symbols in table sorted by length, by symbol order within each + * length + */ + for (symbol = 0; symbol < n; symbol++) + if (length[symbol] != 0) + h->symbol[offs[length[symbol]]++] = symbol; + + /* return zero for complete set, positive for incomplete set */ + return left; +} + +/* + * Decode literal/length and distance codes until an end-of-block code. + * + * Format notes: + * + * - Compressed data that is after the block type if fixed or after the code + * description if dynamic is a combination of literals and length/distance + * pairs terminated by and end-of-block code. Literals are simply Huffman + * coded bytes. A length/distance pair is a coded length followed by a + * coded distance to represent a string that occurs earlier in the + * uncompressed data that occurs again at the current location. + * + * - Literals, lengths, and the end-of-block code are combined into a single + * code of up to 286 symbols. They are 256 literals (0..255), 29 length + * symbols (257..285), and the end-of-block symbol (256). + * + * - There are 256 possible lengths (3..258), and so 29 symbols are not enough + * to represent all of those. Lengths 3..10 and 258 are in fact represented + * by just a length symbol. Lengths 11..257 are represented as a symbol and + * some number of extra bits that are added as an integer to the base length + * of the length symbol. The number of extra bits is determined by the base + * length symbol. These are in the static arrays below, lens[] for the base + * lengths and lext[] for the corresponding number of extra bits. + * + * - The reason that 258 gets its own symbol is that the longest length is used + * often in highly redundant files. Note that 258 can also be coded as the + * base value 227 plus the maximum extra value of 31. While a good deflate + * should never do this, it is not an error, and should be decoded properly. + * + * - If a length is decoded, including its extra bits if any, then it is + * followed a distance code. There are up to 30 distance symbols. Again + * there are many more possible distances (1..32768), so extra bits are added + * to a base value represented by the symbol. The distances 1..4 get their + * own symbol, but the rest require extra bits. The base distances and + * corresponding number of extra bits are below in the static arrays dist[] + * and dext[]. + * + * - Literal bytes are simply written to the output. A length/distance pair is + * an instruction to copy previously uncompressed bytes to the output. The + * copy is from distance bytes back in the output stream, copying for length + * bytes. + * + * - Distances pointing before the beginning of the output data are not + * permitted. + * + * - Overlapped copies, where the length is greater than the distance, are + * allowed and common. For example, a distance of one and a length of 258 + * simply copies the last byte 258 times. A distance of four and a length of + * twelve copies the last four bytes three times. A simple forward copy + * ignoring whether the length is greater than the distance or not implements + * this correctly. You should not use memcpy() since its behavior is not + * defined for overlapped arrays. You should not use memmove() or bcopy() + * since though their behavior -is- defined for overlapping arrays, it is + * defined to do the wrong thing in this case. + */ +local int codes(struct state *s, + const struct huffman *lencode, + const struct huffman *distcode) +{ + int symbol; /* decoded symbol */ + int len; /* length for copy */ + unsigned dist; /* distance for copy */ + static const short lens[29] = { /* Size base for length codes 257..285 */ + 3, 4, 5, 6, 7, 8, 9, 10, 11, 13, 15, 17, 19, 23, 27, 31, + 35, 43, 51, 59, 67, 83, 99, 115, 131, 163, 195, 227, 258}; + static const short lext[29] = { /* Extra bits for length codes 257..285 */ + 0, 0, 0, 0, 0, 0, 0, 0, 1, 1, 1, 1, 2, 2, 2, 2, + 3, 3, 3, 3, 4, 4, 4, 4, 5, 5, 5, 5, 0}; + static const short dists[30] = { /* Offset base for distance codes 0..29 */ + 1, 2, 3, 4, 5, 7, 9, 13, 17, 25, 33, 49, 65, 97, 129, 193, + 257, 385, 513, 769, 1025, 1537, 2049, 3073, 4097, 6145, + 8193, 12289, 16385, 24577}; + static const short dext[30] = { /* Extra bits for distance codes 0..29 */ + 0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, + 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, + 12, 12, 13, 13}; + + /* decode literals and length/distance pairs */ + do { + symbol = decode(s, lencode); + if (symbol < 0) + return symbol; /* invalid symbol */ + if (symbol < 256) { /* literal: symbol is the byte */ + /* write out the literal */ + if (s->out != NIL) { + if (s->outcnt == s->outlen) + return 1; + s->out[s->outcnt] = symbol; + } + s->outcnt++; + } + else if (symbol > 256) { /* length */ + /* get and compute length */ + symbol -= 257; + if (symbol >= 29) + return -10; /* invalid fixed code */ + len = lens[symbol] + bits(s, lext[symbol]); + + /* get and check distance */ + symbol = decode(s, distcode); + if (symbol < 0) + return symbol; /* invalid symbol */ + dist = dists[symbol] + bits(s, dext[symbol]); +#ifndef INFLATE_ALLOW_INVALID_DISTANCE_TOOFAR_ARRR + if (dist > s->outcnt) + return -11; /* distance too far back */ +#endif + + /* copy length bytes from distance bytes back */ + if (s->out != NIL) { + if (s->outcnt + len > s->outlen) + return 1; + while (len--) { + s->out[s->outcnt] = +#ifdef INFLATE_ALLOW_INVALID_DISTANCE_TOOFAR_ARRR + dist > s->outcnt ? + 0 : +#endif + s->out[s->outcnt - dist]; + s->outcnt++; + } + } + else + s->outcnt += len; + } + } while (symbol != 256); /* end of block symbol */ + + /* done with a valid fixed or dynamic block */ + return 0; +} + +/* + * Process a fixed codes block. + * + * Format notes: + * + * - This block type can be useful for compressing small amounts of data for + * which the size of the code descriptions in a dynamic block exceeds the + * benefit of custom codes for that block. For fixed codes, no bits are + * spent on code descriptions. Instead the code lengths for literal/length + * codes and distance codes are fixed. The specific lengths for each symbol + * can be seen in the "for" loops below. + * + * - The literal/length code is complete, but has two symbols that are invalid + * and should result in an error if received. This cannot be implemented + * simply as an incomplete code since those two symbols are in the "middle" + * of the code. They are eight bits long and the longest literal/length\ + * code is nine bits. Therefore the code must be constructed with those + * symbols, and the invalid symbols must be detected after decoding. + * + * - The fixed distance codes also have two invalid symbols that should result + * in an error if received. Since all of the distance codes are the same + * length, this can be implemented as an incomplete code. Then the invalid + * codes are detected while decoding. + */ +local int fixed(struct state *s) +{ + static int virgin = 1; + static short lencnt[MAXBITS+1], lensym[FIXLCODES]; + static short distcnt[MAXBITS+1], distsym[MAXDCODES]; + static struct huffman lencode, distcode; + + /* build fixed huffman tables if first call (may not be thread safe) */ + if (virgin) { + int symbol; + short lengths[FIXLCODES]; + + /* construct lencode and distcode */ + lencode.count = lencnt; + lencode.symbol = lensym; + distcode.count = distcnt; + distcode.symbol = distsym; + + /* literal/length table */ + for (symbol = 0; symbol < 144; symbol++) + lengths[symbol] = 8; + for (; symbol < 256; symbol++) + lengths[symbol] = 9; + for (; symbol < 280; symbol++) + lengths[symbol] = 7; + for (; symbol < FIXLCODES; symbol++) + lengths[symbol] = 8; + construct(&lencode, lengths, FIXLCODES); + + /* distance table */ + for (symbol = 0; symbol < MAXDCODES; symbol++) + lengths[symbol] = 5; + construct(&distcode, lengths, MAXDCODES); + + /* do this just once */ + virgin = 0; + } + + /* decode data until end-of-block code */ + return codes(s, &lencode, &distcode); +} + +/* + * Process a dynamic codes block. + * + * Format notes: + * + * - A dynamic block starts with a description of the literal/length and + * distance codes for that block. New dynamic blocks allow the compressor to + * rapidly adapt to changing data with new codes optimized for that data. + * + * - The codes used by the deflate format are "canonical", which means that + * the actual bits of the codes are generated in an unambiguous way simply + * from the number of bits in each code. Therefore the code descriptions + * are simply a list of code lengths for each symbol. + * + * - The code lengths are stored in order for the symbols, so lengths are + * provided for each of the literal/length symbols, and for each of the + * distance symbols. + * + * - If a symbol is not used in the block, this is represented by a zero as the + * code length. This does not mean a zero-length code, but rather that no + * code should be created for this symbol. There is no way in the deflate + * format to represent a zero-length code. + * + * - The maximum number of bits in a code is 15, so the possible lengths for + * any code are 1..15. + * + * - The fact that a length of zero is not permitted for a code has an + * interesting consequence. Normally if only one symbol is used for a given + * code, then in fact that code could be represented with zero bits. However + * in deflate, that code has to be at least one bit. So for example, if + * only a single distance base symbol appears in a block, then it will be + * represented by a single code of length one, in particular one 0 bit. This + * is an incomplete code, since if a 1 bit is received, it has no meaning, + * and should result in an error. So incomplete distance codes of one symbol + * should be permitted, and the receipt of invalid codes should be handled. + * + * - It is also possible to have a single literal/length code, but that code + * must be the end-of-block code, since every dynamic block has one. This + * is not the most efficient way to create an empty block (an empty fixed + * block is fewer bits), but it is allowed by the format. So incomplete + * literal/length codes of one symbol should also be permitted. + * + * - If there are only literal codes and no lengths, then there are no distance + * codes. This is represented by one distance code with zero bits. + * + * - The list of up to 286 length/literal lengths and up to 30 distance lengths + * are themselves compressed using Huffman codes and run-length encoding. In + * the list of code lengths, a 0 symbol means no code, a 1..15 symbol means + * that length, and the symbols 16, 17, and 18 are run-length instructions. + * Each of 16, 17, and 18 are followed by extra bits to define the length of + * the run. 16 copies the last length 3 to 6 times. 17 represents 3 to 10 + * zero lengths, and 18 represents 11 to 138 zero lengths. Unused symbols + * are common, hence the special coding for zero lengths. + * + * - The symbols for 0..18 are Huffman coded, and so that code must be + * described first. This is simply a sequence of up to 19 three-bit values + * representing no code (0) or the code length for that symbol (1..7). + * + * - A dynamic block starts with three fixed-size counts from which is computed + * the number of literal/length code lengths, the number of distance code + * lengths, and the number of code length code lengths (ok, you come up with + * a better name!) in the code descriptions. For the literal/length and + * distance codes, lengths after those provided are considered zero, i.e. no + * code. The code length code lengths are received in a permuted order (see + * the order[] array below) to make a short code length code length list more + * likely. As it turns out, very short and very long codes are less likely + * to be seen in a dynamic code description, hence what may appear initially + * to be a peculiar ordering. + * + * - Given the number of literal/length code lengths (nlen) and distance code + * lengths (ndist), then they are treated as one long list of nlen + ndist + * code lengths. Therefore run-length coding can and often does cross the + * boundary between the two sets of lengths. + * + * - So to summarize, the code description at the start of a dynamic block is + * three counts for the number of code lengths for the literal/length codes, + * the distance codes, and the code length codes. This is followed by the + * code length code lengths, three bits each. This is used to construct the + * code length code which is used to read the remainder of the lengths. Then + * the literal/length code lengths and distance lengths are read as a single + * set of lengths using the code length codes. Codes are constructed from + * the resulting two sets of lengths, and then finally you can start + * decoding actual compressed data in the block. + * + * - For reference, a "typical" size for the code description in a dynamic + * block is around 80 bytes. + */ +local int dynamic(struct state *s) +{ + int nlen, ndist, ncode; /* number of lengths in descriptor */ + int index; /* index of lengths[] */ + int err; /* construct() return value */ + short lengths[MAXCODES]; /* descriptor code lengths */ + short lencnt[MAXBITS+1], lensym[MAXLCODES]; /* lencode memory */ + short distcnt[MAXBITS+1], distsym[MAXDCODES]; /* distcode memory */ + struct huffman lencode, distcode; /* length and distance codes */ + static const short order[19] = /* permutation of code length codes */ + {16, 17, 18, 0, 8, 7, 9, 6, 10, 5, 11, 4, 12, 3, 13, 2, 14, 1, 15}; + + /* construct lencode and distcode */ + lencode.count = lencnt; + lencode.symbol = lensym; + distcode.count = distcnt; + distcode.symbol = distsym; + + /* get number of lengths in each table, check lengths */ + nlen = bits(s, 5) + 257; + ndist = bits(s, 5) + 1; + ncode = bits(s, 4) + 4; + if (nlen > MAXLCODES || ndist > MAXDCODES) + return -3; /* bad counts */ + + /* read code length code lengths (really), missing lengths are zero */ + for (index = 0; index < ncode; index++) + lengths[order[index]] = bits(s, 3); + for (; index < 19; index++) + lengths[order[index]] = 0; + + /* build huffman table for code lengths codes (use lencode temporarily) */ + err = construct(&lencode, lengths, 19); + if (err != 0) /* require complete code set here */ + return -4; + + /* read length/literal and distance code length tables */ + index = 0; + while (index < nlen + ndist) { + int symbol; /* decoded value */ + int len; /* last length to repeat */ + + symbol = decode(s, &lencode); + if (symbol < 0) + return symbol; /* invalid symbol */ + if (symbol < 16) /* length in 0..15 */ + lengths[index++] = symbol; + else { /* repeat instruction */ + len = 0; /* assume repeating zeros */ + if (symbol == 16) { /* repeat last length 3..6 times */ + if (index == 0) + return -5; /* no last length! */ + len = lengths[index - 1]; /* last length */ + symbol = 3 + bits(s, 2); + } + else if (symbol == 17) /* repeat zero 3..10 times */ + symbol = 3 + bits(s, 3); + else /* == 18, repeat zero 11..138 times */ + symbol = 11 + bits(s, 7); + if (index + symbol > nlen + ndist) + return -6; /* too many lengths! */ + while (symbol--) /* repeat last or zero symbol times */ + lengths[index++] = len; + } + } + + /* check for end-of-block code -- there better be one! */ + if (lengths[256] == 0) + return -9; + + /* build huffman table for literal/length codes */ + err = construct(&lencode, lengths, nlen); + if (err && (err < 0 || nlen != lencode.count[0] + lencode.count[1])) + return -7; /* incomplete code ok only for single length 1 code */ + + /* build huffman table for distance codes */ + err = construct(&distcode, lengths + nlen, ndist); + if (err && (err < 0 || ndist != distcode.count[0] + distcode.count[1])) + return -8; /* incomplete code ok only for single length 1 code */ + + /* decode data until end-of-block code */ + return codes(s, &lencode, &distcode); +} + +/* + * Inflate source to dest. On return, destlen and sourcelen are updated to the + * size of the uncompressed data and the size of the deflate data respectively. + * On success, the return value of puff() is zero. If there is an error in the + * source data, i.e. it is not in the deflate format, then a negative value is + * returned. If there is not enough input available or there is not enough + * output space, then a positive error is returned. In that case, destlen and + * sourcelen are not updated to facilitate retrying from the beginning with the + * provision of more input data or more output space. In the case of invalid + * inflate data (a negative error), the dest and source pointers are updated to + * facilitate the debugging of deflators. + * + * puff() also has a mode to determine the size of the uncompressed output with + * no output written. For this dest must be (unsigned char *)0. In this case, + * the input value of *destlen is ignored, and on return *destlen is set to the + * size of the uncompressed output. + * + * The return codes are: + * + * 2: available inflate data did not terminate + * 1: output space exhausted before completing inflate + * 0: successful inflate + * -1: invalid block type (type == 3) + * -2: stored block length did not match one's complement + * -3: dynamic block code description: too many length or distance codes + * -4: dynamic block code description: code lengths codes incomplete + * -5: dynamic block code description: repeat lengths with no first length + * -6: dynamic block code description: repeat more than specified lengths + * -7: dynamic block code description: invalid literal/length code lengths + * -8: dynamic block code description: invalid distance code lengths + * -9: dynamic block code description: missing end-of-block code + * -10: invalid literal/length or distance code in fixed or dynamic block + * -11: distance is too far back in fixed or dynamic block + * + * Format notes: + * + * - Three bits are read for each block to determine the kind of block and + * whether or not it is the last block. Then the block is decoded and the + * process repeated if it was not the last block. + * + * - The leftover bits in the last byte of the deflate data after the last + * block (if it was a fixed or dynamic block) are undefined and have no + * expected values to check. + */ +int puff(unsigned char *dest, /* pointer to destination pointer */ + unsigned long *destlen, /* amount of output space */ + const unsigned char *source, /* pointer to source data pointer */ + unsigned long *sourcelen) /* amount of input available */ +{ + struct state s; /* input/output state */ + int last, type; /* block information */ + int err; /* return value */ + + /* initialize output state */ + s.out = dest; + s.outlen = *destlen; /* ignored if dest is NIL */ + s.outcnt = 0; + + /* initialize input state */ + s.in = source; + s.inlen = *sourcelen; + s.incnt = 0; + s.bitbuf = 0; + s.bitcnt = 0; + + /* return if bits() or decode() tries to read past available input */ + if (setjmp(s.env) != 0) /* if came back here via longjmp() */ + err = 2; /* then skip do-loop, return error */ + else { + /* process blocks until last block or error */ + do { + last = bits(&s, 1); /* one if last block */ + type = bits(&s, 2); /* block type 0..3 */ + err = type == 0 ? + stored(&s) : + (type == 1 ? + fixed(&s) : + (type == 2 ? + dynamic(&s) : + -1)); /* type == 3, invalid */ + if (err != 0) + break; /* return with error */ + } while (!last); + } + + /* update the lengths and return */ + if (err <= 0) { + *destlen = s.outcnt; + *sourcelen = s.incnt; + } + return err; +} diff --git a/lib/obp60task/puff.h b/lib/obp60task/puff.h new file mode 100644 index 0000000..e23a245 --- /dev/null +++ b/lib/obp60task/puff.h @@ -0,0 +1,35 @@ +/* puff.h + Copyright (C) 2002-2013 Mark Adler, all rights reserved + version 2.3, 21 Jan 2013 + + This software is provided 'as-is', without any express or implied + warranty. In no event will the author be held liable for any damages + arising from the use of this software. + + Permission is granted to anyone to use this software for any purpose, + including commercial applications, and to alter it and redistribute it + freely, subject to the following restrictions: + + 1. The origin of this software must not be misrepresented; you must not + claim that you wrote the original software. If you use this software + in a product, an acknowledgment in the product documentation would be + appreciated but is not required. + 2. Altered source versions must be plainly marked as such, and must not be + misrepresented as being the original software. + 3. This notice may not be removed or altered from any source distribution. + + Mark Adler madler@alumni.caltech.edu + */ + + +/* + * See puff.c for purpose and usage. + */ +#ifndef NIL +# define NIL ((unsigned char *)0) /* for no output option */ +#endif + +int puff(unsigned char *dest, /* pointer to destination pointer */ + unsigned long *destlen, /* amount of output space */ + const unsigned char *source, /* pointer to source data pointer */ + unsigned long *sourcelen); /* amount of input available */ diff --git a/lib/obp60task/run_install_tools b/lib/obp60task/run_install_tools index 9c4667e..c46c10c 100644 --- a/lib/obp60task/run_install_tools +++ b/lib/obp60task/run_install_tools @@ -8,6 +8,6 @@ # Install tools echo "Installing tools" -cd /workspace/esp32-nmea2000 +cd /workspaces/esp32-nmea2000 pip3 install -U esptool pip3 install platformio diff --git a/lib/sensors/GwSensor.cpp b/lib/sensors/GwSensor.cpp index d0d580b..e65e22e 100644 --- a/lib/sensors/GwSensor.cpp +++ b/lib/sensors/GwSensor.cpp @@ -3,7 +3,7 @@ This code 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 2.1 of the License, or (at your option) any later version. + version 2 of the License, or (at your option) any later version. This code 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 @@ -17,4 +17,4 @@ void SensorList::add(SensorBase::Ptr sensor){ this->push_back(sensor); - } \ No newline at end of file + } diff --git a/lib/sensors/GwSensor.h b/lib/sensors/GwSensor.h index 3077360..e263ebf 100644 --- a/lib/sensors/GwSensor.h +++ b/lib/sensors/GwSensor.h @@ -3,7 +3,7 @@ This code 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 2.1 of the License, or (at your option) any later version. + version 2 of the License, or (at your option) any later version. This code 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 @@ -93,6 +93,7 @@ class GwSensorConfig{ } bool readConfig(T* s,GwConfigHandler *cfg){ if (s == nullptr) return false; + if (prefix != s->prefix) return false; configReader(s,cfg); return s->ok; } @@ -134,4 +135,4 @@ class GwSensorConfigInitializerList : public GwInitializer>::L cfg->getValue(name, GwConfigDefinitions::prefix ## name) -#endif \ No newline at end of file +#endif diff --git a/lib/serial/GwSerial.cpp b/lib/serial/GwSerial.cpp index b23c52f..ed469f9 100644 --- a/lib/serial/GwSerial.cpp +++ b/lib/serial/GwSerial.cpp @@ -66,18 +66,8 @@ GwSerial::~GwSerial() if (lock != nullptr) vSemaphoreDelete(lock); } -String GwSerial::getMode(){ - switch (type){ - case GWSERIAL_TYPE_UNI: - return "UNI"; - case GWSERIAL_TYPE_BI: - return "BI"; - case GWSERIAL_TYPE_RX: - return "RX"; - case GWSERIAL_TYPE_TX: - return "TX"; - } - return "UNKNOWN"; +int GwSerial::getType() { + return type; } bool GwSerial::isInitialized() { return initialized; } diff --git a/lib/serial/GwSerial.h b/lib/serial/GwSerial.h index 1932878..354e084 100644 --- a/lib/serial/GwSerial.h +++ b/lib/serial/GwSerial.h @@ -42,7 +42,7 @@ class GwSerial : public GwChannelInterface{ virtual Stream *getStream(bool partialWrites); bool getAvailableWrite(){return availableWrite;} virtual void begin(unsigned long baud, uint32_t config=SERIAL_8N1, int8_t rxPin=-1, int8_t txPin=-1)=0; - virtual String getMode() override; + virtual int getType() override; friend GwSerialStream; }; @@ -122,7 +122,8 @@ template setError(serial,logger); }; + }; -#endif \ No newline at end of file +#endif diff --git a/lib/socketserver/GwUdpReader.cpp b/lib/socketserver/GwUdpReader.cpp index 612eb10..5beacbc 100644 --- a/lib/socketserver/GwUdpReader.cpp +++ b/lib/socketserver/GwUdpReader.cpp @@ -6,7 +6,6 @@ #include "GwSocketHelper.h" #include "GWWifi.h" - GwUdpReader::GwUdpReader(const GwConfigHandler *config, GwLog *logger, int minId) { this->config = config; @@ -164,4 +163,4 @@ size_t GwUdpReader::sendToClients(const char *buf, int source,bool partial) GwUdpReader::~GwUdpReader() { -} \ No newline at end of file +} diff --git a/lib/spitask/GWDMS22B.cpp b/lib/spitask/GWDMS22B.cpp index fca345e..0447fb2 100644 --- a/lib/spitask/GWDMS22B.cpp +++ b/lib/spitask/GWDMS22B.cpp @@ -3,7 +3,7 @@ This code 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 2.1 of the License, or (at your option) any later version. + version 2 of the License, or (at your option) any later version. This code 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 diff --git a/lib/spitask/GWDMS22B.h b/lib/spitask/GWDMS22B.h index de53804..92559ed 100644 --- a/lib/spitask/GWDMS22B.h +++ b/lib/spitask/GWDMS22B.h @@ -3,7 +3,7 @@ This code 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 2.1 of the License, or (at your option) any later version. + version 2 of the License, or (at your option) any later version. This code 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 @@ -19,4 +19,4 @@ SSI sensor DMS22B - https://www.mouser.de/datasheet/2/54/bour_s_a0011704065_1-22 #define _GWDMS22B_H #include "GwSpiSensor.h" void registerDMS22B(GwApi *api); -#endif \ No newline at end of file +#endif diff --git a/lib/spitask/GwSpiSensor.h b/lib/spitask/GwSpiSensor.h index c12a410..ec21afe 100644 --- a/lib/spitask/GwSpiSensor.h +++ b/lib/spitask/GwSpiSensor.h @@ -3,7 +3,7 @@ This code 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 2.1 of the License, or (at your option) any later version. + version 2 of the License, or (at your option) any later version. This code 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 diff --git a/lib/spitask/GwSpiTask.cpp b/lib/spitask/GwSpiTask.cpp index a5dda8a..741576f 100644 --- a/lib/spitask/GwSpiTask.cpp +++ b/lib/spitask/GwSpiTask.cpp @@ -3,7 +3,7 @@ This code 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 2.1 of the License, or (at your option) any later version. + version 2 of the License, or (at your option) any later version. This code 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 @@ -140,4 +140,4 @@ void initSpiTask(GwApi *api){ else{ LOG_DEBUG(GwLog::LOG,"no SPI sensors defined/active"); } -} \ No newline at end of file +} diff --git a/lib/spitask/GwSpiTask.h b/lib/spitask/GwSpiTask.h index 0714a31..e6348e0 100644 --- a/lib/spitask/GwSpiTask.h +++ b/lib/spitask/GwSpiTask.h @@ -3,7 +3,7 @@ This code 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 2.1 of the License, or (at your option) any later version. + version 2 of the License, or (at your option) any later version. This code 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 @@ -17,4 +17,4 @@ #include "GwApi.h" void initSpiTask(GwApi *api); DECLARE_INITFUNCTION_ORDER(initSpiTask,GWLATEORDER); -#endif \ No newline at end of file +#endif diff --git a/lib/statistics/GwStatistics.h b/lib/statistics/GwStatistics.h index b2efec8..fbf7c5e 100644 --- a/lib/statistics/GwStatistics.h +++ b/lib/statistics/GwStatistics.h @@ -1,5 +1,13 @@ #pragma once #include +#include +#include + +static inline int64_t gwMonotonicUs(){ + TickType_t ticks=xTaskGetTickCount(); + return ((int64_t)ticks) * ((int64_t)portTICK_PERIOD_MS) * 1000; +} + class TimeAverage{ double factor=0.3; double current=0; @@ -70,7 +78,7 @@ class TimeMonitor{ } void reset(){ if (last != 0 && start != 0) loop->add(last-start); - start=esp_timer_get_time(); + start=gwMonotonicUs(); for (size_t i=0;igetNMEA2000(); } + virtual tN2kDeviceList *getN2kDeviceList() + { + return api->getN2kDeviceList(); + } virtual GwBoatData *getBoatData() { return api->getBoatData(); diff --git a/lib/xdrmappings/GwXDRMappings.cpp b/lib/xdrmappings/GwXDRMappings.cpp index 28f88c2..be86f3b 100644 --- a/lib/xdrmappings/GwXDRMappings.cpp +++ b/lib/xdrmappings/GwXDRMappings.cpp @@ -431,7 +431,8 @@ GwXDRFoundMapping GwXDRMappings::getMapping(String xName,String xType,String xUn } return selectMapping(&(it->second),instance,n183Key.c_str()); } -GwXDRFoundMapping GwXDRMappings::getMapping(GwXDRCategory category,int selector,int field,int instance){ +GwXDRFoundMapping GwXDRMappings::getMapping(double value,GwXDRCategory category,int selector,int field,int instance){ + if (value == N2kDoubleNA) return GwXDRFoundMapping(); //do not add to unknown mappings unsigned long n2kKey=GwXDRMappingDef::n2kKey(category,selector,field); auto it=n2kMap.find(n2kKey); if (it == n2kMap.end()){ @@ -502,4 +503,4 @@ String GwXDRMappings::getXdrEntry(String mapping, double value,int instance){ const GwXDRType * GwXDRMappings::findType(const String &typeString, const String &unitString) const{ return ::findType(typeString,unitString); -} \ No newline at end of file +} diff --git a/lib/xdrmappings/GwXDRMappings.h b/lib/xdrmappings/GwXDRMappings.h index 198a729..d747368 100644 --- a/lib/xdrmappings/GwXDRMappings.h +++ b/lib/xdrmappings/GwXDRMappings.h @@ -244,11 +244,11 @@ class GwXDRMappings{ //get the mappings //the returned mapping will exactly contain one mapping def GwXDRFoundMapping getMapping(String xName,String xType,String xUnit); - GwXDRFoundMapping getMapping(GwXDRCategory category,int selector,int field=0,int instance=-1); + GwXDRFoundMapping getMapping(double value,GwXDRCategory category,int selector,int field=0,int instance=-1); String getXdrEntry(String mapping, double value,int instance=0); const char * getUnMapped(); const GwXDRType * findType(const String &typeString, const String &unitString) const; }; -#endif \ No newline at end of file +#endif diff --git a/platformio.ini b/platformio.ini index 0f91a89..be2ae23 100644 --- a/platformio.ini +++ b/platformio.ini @@ -18,11 +18,11 @@ extra_configs= [basedeps] lib_deps = - ttlappalainen/NMEA2000-library @ 4.22.0 + ttlappalainen/NMEA2000-library @ 4.22.0 ttlappalainen/NMEA0183 @ 1.10.1 ArduinoJson @ 6.18.5 - ESP32Async/AsyncTCP @ 3.4.7 - ESP32Async/ESPAsyncWebServer @ 3.8.0 + ESP32Async/AsyncTCP @ 3.4.7 + ESP32Async/ESPAsyncWebServer @ 3.8.0 FS Preferences ESPmDNS @@ -190,3 +190,14 @@ build_flags = ${env.build_flags} upload_port = /dev/esp32 upload_protocol = esptool + +[env:s3devkitm-generic] +extends = sensors +board = esp32-s3-devkitm-1 +lib_deps = + ${env.lib_deps} + ${sensors.lib_deps} +build_flags = + ${env.build_flags} +upload_port = /dev/esp32 +upload_protocol = esptool diff --git a/post.py b/post.py index 8fe2f27..a09635f 100644 --- a/post.py +++ b/post.py @@ -2,6 +2,7 @@ Import("env", "projenv") import os import glob import shutil +import re print("##post script running") HDROFFSET=288 @@ -39,6 +40,7 @@ def post(source,target,env): appoffset=env.subst("$ESP32_APP_OFFSET") firmware=env.subst("$BUILD_DIR/${PROGNAME}.bin") (fwname,version)=getFirmwareInfo(firmware) + fwname=re.sub(r"[^0-9A-Za-z_.-]*","",fwname) print("found fwname=%s, fwversion=%s"%(fwname,version)) python=env.subst("$PYTHONEXE") print("base=%s,esptool=%s,appoffset=%s,uploaderflags=%s"%(base,esptool,appoffset,uploaderflags)) @@ -70,10 +72,12 @@ def post(source,target,env): print("running %s"%" ".join(cmd)) env.Execute(" ".join(cmd),"#testpost") ofversion="-"+version - versionedFile=os.path.join(outdir,"%s%s-update.bin"%(base,ofversion)) + versionedFile=os.path.join(outdir,"%s%s-update.bin"%(fwname,ofversion)) shutil.copyfile(firmware,versionedFile) - versioneOutFile=os.path.join(outdir,"%s%s-all.bin"%(base,ofversion)) + print(f"wrote {versionedFile}") + versioneOutFile=os.path.join(outdir,"%s%s-all.bin"%(fwname,ofversion)) shutil.copyfile(outfile,versioneOutFile) + print(f"wrote {versioneOutFile}") env.AddPostAction( "$BUILD_DIR/${PROGNAME}.bin", post diff --git a/src/main.cpp b/src/main.cpp index 1e03760..5367a34 100644 --- a/src/main.cpp +++ b/src/main.cpp @@ -3,7 +3,7 @@ This code 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 2.1 of the License, or (at your option) any later version. + version 2 of the License, or (at your option) any later version. This code 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 @@ -72,9 +72,9 @@ const unsigned long HEAP_REPORT_TIME=2000; //set to 0 to disable heap reporting #define MAX_NMEA2000_MESSAGE_SEASMART_SIZE 500 #define MAX_NMEA0183_MESSAGE_SIZE MAX_NMEA2000_MESSAGE_SEASMART_SIZE //assert length of firmware name and version -CASSERT(strlen(FIRMWARE_TYPE) <= 32, "environment name (FIRMWARE_TYPE) must not exceed 32 chars"); -CASSERT(strlen(VERSION) <= 32, "VERSION must not exceed 32 chars"); -CASSERT(strlen(IDF_VERSION) <= 32,"IDF_VERSION must not exceed 32 chars"); +CASSERT(strlen(FIRMWARE_TYPE) <= 31, "environment name (FIRMWARE_TYPE) must not exceed 32 chars"); +CASSERT(strlen(VERSION) <= 31, "VERSION must not exceed 32 chars"); +CASSERT(strlen(IDF_VERSION) <= 31,"IDF_VERSION must not exceed 32 chars"); //https://docs.espressif.com/projects/esp-idf/en/latest/esp32/api-reference/system/app_image_format.html //and removed the bugs in the doc... __attribute__((section(".rodata_custom_desc"))) esp_app_desc_t custom_app_desc = { @@ -100,6 +100,7 @@ GwLog logger(LOGLEVEL,NULL); GwConfigHandler config(&logger); #include "Nmea2kTwai.h" +#include static const unsigned long CAN_RECOVERY_PERIOD=3000; //ms static const unsigned long NMEA2000_HEARTBEAT_INTERVAL=5000; class Nmea2kTwaiLog : public Nmea2kTwai{ @@ -126,6 +127,7 @@ class Nmea2kTwaiLog : public Nmea2kTwai{ #endif Nmea2kTwai &NMEA2000=*(new Nmea2kTwaiLog((gpio_num_t)ESP32_CAN_TX_PIN,(gpio_num_t)ESP32_CAN_RX_PIN,CAN_RECOVERY_PERIOD,&logger)); +tN2kDeviceList *pN2kDeviceList; #ifdef GWBUTTON_PIN bool fixedApPass=false; @@ -342,6 +344,9 @@ public: virtual Nmea2kTwai *getNMEA2000(){ return &NMEA2000; } + virtual tN2kDeviceList *getN2kDeviceList(){ + return pN2kDeviceList; + } virtual GwBoatData *getBoatData(){ return &boatData; } @@ -776,7 +781,7 @@ void loopFunction(void *){ //if(Serial1.available()) {} //if(Serial.available()) {} //if(Serial2.available()) {} - //delay(1); + vTaskDelay(1); } } const String USERPREFIX="/api/user/"; @@ -944,6 +949,7 @@ void setup() { NMEA2000.SetMsgHandler([](const tN2kMsg &n2kMsg){ handleN2kMessage(n2kMsg,N2K_CHANNEL_ID); }); + pN2kDeviceList = new tN2kDeviceList(&NMEA2000); NMEA2000.Open(); logger.logDebug(GwLog::LOG,"starting addon tasks"); logger.flush(); diff --git a/tools/gen3byte.py b/tools/gen3byte.py new file mode 100755 index 0000000..2d84518 --- /dev/null +++ b/tools/gen3byte.py @@ -0,0 +1,32 @@ +#! /usr/bin/env python3 +#generate 3 byte codes for the RGB bytes +#refer to https://controllerstech.com/ws2812-leds-using-spi/ +ONE_BIT='110' +ZERO_BIT='100' + +currentStr='' + +def checkAndPrint(curr): + if len(curr) >= 8: + print("0b%s,"%curr[0:8],end='') + return curr[8:] + return curr +first=True + +print("uint8_t colorTo3Byte[256][3]=") +print("{") +for i in range(0,256): + if not first: + print("},") + first=False + print("{/*%02d*/"%i,end='') + mask=0x80 + for b in range(0,8): + if (i & mask) != 0: + currentStr+=ONE_BIT + else: + currentStr+=ZERO_BIT + mask=mask >> 1 + currentStr=checkAndPrint(currentStr) +print("}") +print("};") diff --git a/tools/getPgnType.py b/tools/getPgnType.py new file mode 100755 index 0000000..edbdbb2 --- /dev/null +++ b/tools/getPgnType.py @@ -0,0 +1,29 @@ +#! /usr/bin/env python3 +import sys +import json + +def err(txt): + print(txt,file=sys.stderr) + sys.exit(1) + +HDR=''' +PGNM_Fast=0 +PGNM_Single=1 +PGNM_ISO=2 +PGN_MODES={ +''' +FOOTER=''' + } +''' +with open(sys.argv[1],"r") as ih: + data=json.load(ih) + pgns=data.get('PGNs') + if pgns is None: + err("no pgns") + print(HDR) + for p in pgns: + t=p['Type'] + pgn=p['PGN'] + if t and pgn: + print(f" {pgn}: PGNM_{t},") + print(FOOTER) \ No newline at end of file diff --git a/tools/sendDelay.py b/tools/sendDelay.py new file mode 100755 index 0000000..ab91737 --- /dev/null +++ b/tools/sendDelay.py @@ -0,0 +1,19 @@ +#! /usr/bin/env python3 +import sys +import os +import time + +def usage(): + print(f"usage: {sys.argv[0]} file delay") + sys.exit(1) + +if len(sys.argv) < 3: + usage() + +delay=float(sys.argv[2]) +fn=sys.argv[1] +with open (fn,"r") as fh: + for line in fh: + print(line,end="",flush=True) + time.sleep(delay) + diff --git a/tools/sendN2K.py b/tools/sendN2K.py new file mode 100755 index 0000000..e5c55db --- /dev/null +++ b/tools/sendN2K.py @@ -0,0 +1,793 @@ +#! /usr/bin/env python3 +import re +import sys +import os +import datetime +import getopt +import time + +###generated with getPgnType.py from canboat pgns.json +PGNM_Fast=0 +PGNM_Single=1 +PGNM_ISO=2 +PGN_MODES={ + + 59392: PGNM_Single, + 59904: PGNM_Single, + 60160: PGNM_Single, + 60416: PGNM_Single, + 60416: PGNM_Single, + 60416: PGNM_Single, + 60416: PGNM_Single, + 60416: PGNM_Single, + 60928: PGNM_Single, + 61184: PGNM_Single, + 61184: PGNM_Single, + 61184: PGNM_Single, + 65001: PGNM_Single, + 65002: PGNM_Single, + 65003: PGNM_Single, + 65004: PGNM_Single, + 65005: PGNM_Single, + 65006: PGNM_Single, + 65007: PGNM_Single, + 65008: PGNM_Single, + 65009: PGNM_Single, + 65010: PGNM_Single, + 65011: PGNM_Single, + 65012: PGNM_Single, + 65013: PGNM_Single, + 65014: PGNM_Single, + 65015: PGNM_Single, + 65016: PGNM_Single, + 65017: PGNM_Single, + 65018: PGNM_Single, + 65019: PGNM_Single, + 65020: PGNM_Single, + 65021: PGNM_Single, + 65022: PGNM_Single, + 65023: PGNM_Single, + 65024: PGNM_Single, + 65025: PGNM_Single, + 65026: PGNM_Single, + 65027: PGNM_Single, + 65028: PGNM_Single, + 65029: PGNM_Single, + 65030: PGNM_Single, + 65240: PGNM_ISO, + 65280: PGNM_Single, + 65284: PGNM_Single, + 65285: PGNM_Single, + 65285: PGNM_Single, + 65286: PGNM_Single, + 65286: PGNM_Single, + 65287: PGNM_Single, + 65287: PGNM_Single, + 65288: PGNM_Single, + 65289: PGNM_Single, + 65290: PGNM_Single, + 65292: PGNM_Single, + 65293: PGNM_Single, + 65293: PGNM_Single, + 65302: PGNM_Single, + 65305: PGNM_Single, + 65305: PGNM_Single, + 65305: PGNM_Single, + 65305: PGNM_Single, + 65305: PGNM_Single, + 65309: PGNM_Single, + 65312: PGNM_Single, + 65340: PGNM_Single, + 65341: PGNM_Single, + 65345: PGNM_Single, + 65350: PGNM_Single, + 65359: PGNM_Single, + 65360: PGNM_Single, + 65361: PGNM_Single, + 65371: PGNM_Single, + 65374: PGNM_Single, + 65379: PGNM_Single, + 65408: PGNM_Single, + 65409: PGNM_Single, + 65410: PGNM_Single, + 65420: PGNM_Single, + 65480: PGNM_Single, + 126208: PGNM_Fast, + 126208: PGNM_Fast, + 126208: PGNM_Fast, + 126208: PGNM_Fast, + 126208: PGNM_Fast, + 126208: PGNM_Fast, + 126208: PGNM_Fast, + 126464: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126720: PGNM_Fast, + 126983: PGNM_Fast, + 126984: PGNM_Fast, + 126985: PGNM_Fast, + 126986: PGNM_Fast, + 126987: PGNM_Fast, + 126988: PGNM_Fast, + 126992: PGNM_Single, + 126993: PGNM_Single, + 126996: PGNM_Fast, + 126998: PGNM_Fast, + 127233: PGNM_Fast, + 127237: PGNM_Fast, + 127245: PGNM_Single, + 127250: PGNM_Single, + 127251: PGNM_Single, + 127252: PGNM_Single, + 127257: PGNM_Single, + 127258: PGNM_Single, + 127488: PGNM_Single, + 127489: PGNM_Fast, + 127490: PGNM_Fast, + 127491: PGNM_Fast, + 127493: PGNM_Single, + 127494: PGNM_Fast, + 127495: PGNM_Fast, + 127496: PGNM_Fast, + 127497: PGNM_Fast, + 127498: PGNM_Fast, + 127500: PGNM_Single, + 127501: PGNM_Single, + 127502: PGNM_Single, + 127503: PGNM_Fast, + 127504: PGNM_Fast, + 127505: PGNM_Single, + 127506: PGNM_Fast, + 127507: PGNM_Fast, + 127508: PGNM_Single, + 127509: PGNM_Fast, + 127510: PGNM_Fast, + 127511: PGNM_Single, + 127512: PGNM_Single, + 127513: PGNM_Fast, + 127514: PGNM_Single, + 127744: PGNM_Single, + 127745: PGNM_Single, + 127746: PGNM_Single, + 127750: PGNM_Single, + 127751: PGNM_Single, + 128000: PGNM_Single, + 128001: PGNM_Single, + 128002: PGNM_Single, + 128003: PGNM_Single, + 128006: PGNM_Single, + 128007: PGNM_Single, + 128008: PGNM_Single, + 128259: PGNM_Single, + 128267: PGNM_Single, + 128275: PGNM_Fast, + 128520: PGNM_Fast, + 128538: PGNM_Fast, + 128768: PGNM_Single, + 128769: PGNM_Single, + 128776: PGNM_Single, + 128777: PGNM_Single, + 128778: PGNM_Single, + 128780: PGNM_Single, + 129025: PGNM_Single, + 129026: PGNM_Single, + 129027: PGNM_Single, + 129028: PGNM_Single, + 129029: PGNM_Fast, + 129033: PGNM_Single, + 129038: PGNM_Fast, + 129039: PGNM_Fast, + 129040: PGNM_Fast, + 129041: PGNM_Fast, + 129044: PGNM_Fast, + 129045: PGNM_Fast, + 129283: PGNM_Single, + 129284: PGNM_Fast, + 129285: PGNM_Fast, + 129291: PGNM_Single, + 129301: PGNM_Fast, + 129302: PGNM_Fast, + 129538: PGNM_Fast, + 129539: PGNM_Single, + 129540: PGNM_Fast, + 129541: PGNM_Fast, + 129542: PGNM_Fast, + 129545: PGNM_Fast, + 129546: PGNM_Single, + 129547: PGNM_Fast, + 129549: PGNM_Fast, + 129550: PGNM_Fast, + 129551: PGNM_Fast, + 129556: PGNM_Fast, + 129792: PGNM_Fast, + 129793: PGNM_Fast, + 129794: PGNM_Fast, + 129795: PGNM_Fast, + 129796: PGNM_Fast, + 129797: PGNM_Fast, + 129798: PGNM_Fast, + 129799: PGNM_Fast, + 129800: PGNM_Fast, + 129801: PGNM_Fast, + 129802: PGNM_Fast, + 129803: PGNM_Fast, + 129804: PGNM_Fast, + 129805: PGNM_Fast, + 129806: PGNM_Fast, + 129807: PGNM_Fast, + 129808: PGNM_Fast, + 129808: PGNM_Fast, + 129809: PGNM_Fast, + 129810: PGNM_Fast, + 130052: PGNM_Fast, + 130053: PGNM_Fast, + 130054: PGNM_Fast, + 130060: PGNM_Fast, + 130061: PGNM_Fast, + 130064: PGNM_Fast, + 130065: PGNM_Fast, + 130066: PGNM_Fast, + 130067: PGNM_Fast, + 130068: PGNM_Fast, + 130069: PGNM_Fast, + 130070: PGNM_Fast, + 130071: PGNM_Fast, + 130072: PGNM_Fast, + 130073: PGNM_Fast, + 130074: PGNM_Fast, + 130306: PGNM_Single, + 130310: PGNM_Single, + 130311: PGNM_Single, + 130312: PGNM_Single, + 130313: PGNM_Single, + 130314: PGNM_Single, + 130315: PGNM_Single, + 130316: PGNM_Single, + 130320: PGNM_Fast, + 130321: PGNM_Fast, + 130322: PGNM_Fast, + 130323: PGNM_Fast, + 130324: PGNM_Fast, + 130330: PGNM_Fast, + 130560: PGNM_Single, + 130561: PGNM_Fast, + 130562: PGNM_Fast, + 130563: PGNM_Fast, + 130564: PGNM_Fast, + 130565: PGNM_Fast, + 130566: PGNM_Fast, + 130567: PGNM_Fast, + 130569: PGNM_Fast, + 130570: PGNM_Fast, + 130571: PGNM_Fast, + 130572: PGNM_Fast, + 130573: PGNM_Fast, + 130574: PGNM_Fast, + 130576: PGNM_Single, + 130577: PGNM_Fast, + 130578: PGNM_Fast, + 130579: PGNM_Single, + 130580: PGNM_Fast, + 130581: PGNM_Fast, + 130582: PGNM_Single, + 130583: PGNM_Fast, + 130584: PGNM_Fast, + 130585: PGNM_Single, + 130586: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130816: PGNM_Fast, + 130817: PGNM_Fast, + 130817: PGNM_Fast, + 130818: PGNM_Fast, + 130819: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130820: PGNM_Fast, + 130821: PGNM_Fast, + 130821: PGNM_Fast, + 130822: PGNM_Fast, + 130823: PGNM_Fast, + 130824: PGNM_Fast, + 130824: PGNM_Fast, + 130825: PGNM_Fast, + 130827: PGNM_Fast, + 130828: PGNM_Fast, + 130831: PGNM_Fast, + 130832: PGNM_Fast, + 130833: PGNM_Fast, + 130834: PGNM_Fast, + 130835: PGNM_Fast, + 130836: PGNM_Fast, + 130836: PGNM_Fast, + 130837: PGNM_Fast, + 130837: PGNM_Fast, + 130838: PGNM_Fast, + 130839: PGNM_Fast, + 130840: PGNM_Fast, + 130842: PGNM_Fast, + 130842: PGNM_Fast, + 130842: PGNM_Fast, + 130843: PGNM_Fast, + 130843: PGNM_Fast, + 130845: PGNM_Fast, + 130845: PGNM_Fast, + 130846: PGNM_Fast, + 130846: PGNM_Fast, + 130847: PGNM_Fast, + 130850: PGNM_Fast, + 130850: PGNM_Fast, + 130850: PGNM_Fast, + 130851: PGNM_Fast, + 130856: PGNM_Fast, + 130860: PGNM_Fast, + 130880: PGNM_Fast, + 130881: PGNM_Fast, + 130944: PGNM_Fast, + + } + + + + +def logError(fmt,*args,keep=False): + print("ERROR:" +fmt%(args),file=sys.stderr) + if not keep: + sys.exit(1) + +def dataToSep(data,maxbytes=None): + pd=None + dl=int(len(data)/2) + if maxbytes is not None and maxbytes < dl: + dl=maxbytes + for p in range(0,dl): + i=2*p + if pd is None: + pd=data[i:i+2] + else: + pd+=","+data[i:i+2] + return pd +class Format: + F_PLAIN=0 + N_PLAIN='plain' + F_ACT=1 + N_ACT='actisense' + F_PASS=2 + N_PASS='pass' + F_SEASMART=3 + N_SEASMART="seasmart" + def __init__(self,name,key,merge=True): + self.key=key + self.name=name + self.merge=merge + +class CanFrame: + DUMP_PAT=re.compile(r'\(([^)]*)\) *([^ ]*) *([^#]*)#(.*)') + + def __init__(self,ts,pgn,src=1,dst=255,prio=1,dev=None,hdr=None,data=None): + self.pgn=pgn + self.mode=PGN_MODES.get(pgn) + self.ts=ts + self.src=src + self.dst=dst + self.data=data + self.prio=prio + self.sequence=None + self.frame=None + self.len=8 + self.dev=dev + self.hdr=hdr + if self.mode == PGNM_Fast and data is not None and len(self.data) >= 2: + fb=int(data[0:2],16) + self.frame=fb & 0x1f + self.sequence=fb >> 5 + + def key(self): + if self.sequence is None or self.pgn == 0: + return None + return f"{self.pgn}-{self.sequence}-{self.src}" + def getFPNum(self,bytes=False): + if self.frame != 0: + return None + if len(self.data) < 4: + return None + numbytes=int(self.data[2:4],16) + if bytes: + return numbytes + frames=int((numbytes-6-1)/7)+1+1 if numbytes > 6 else 1 + return frames + + def _formatTs(self): + dt=datetime.datetime.fromtimestamp(self.ts,tz=datetime.UTC) + return dt.strftime("%F-%T.")+dt.strftime("%f")[0:3] + + def __str__(self): + return f"{self._formatTs()},{self.prio},{self.pgn},{self.src},{self.dst},{self.len},{dataToSep(self.data)}" + + def printOut(self,format:Format): + if format.key == Format.F_PASS: + return f"({self.ts:.6f}) {self.dev} {self.hdr}#{self.data}" + else: + return str(self) + + + @classmethod + def fromDump(cls,line:str): + '''(1658058069.867835) can0 09F80103#ACAF6C20B79AAC06''' + if line is None or line == '': + return None + match=cls.DUMP_PAT.search(line) + if match is None: + logError("no dump pattern in line %s",line,keep=True) + return + ts=match[1] + data=match[4] + hdr=match[3] + hdrval=int(hdr,16) + #see candump2analyzer + src=hdrval & 0xff + prio=(hdrval >> 26) & 0x7 + PF=(hdrval >> 16) & 0xff + PS=(hdrval >> 8) & 0xff + RDP=(hdrval >> 24) & 3 + pgn=0 + if PF < 240: + dst=PS + pgn=(RDP << 16) + (PF << 8) + else: + dst=0xff + pgn=(RDP << 16) + (PF << 8)+PS + return CanFrame(float(ts),pgn,src=src,dst=dst,prio=prio,data=data,dev=match[2],hdr=hdr) + +class MultiFrame(CanFrame): + def __init__(self,firstFrame: CanFrame): + super().__init__(firstFrame.ts,firstFrame.pgn, + src=firstFrame.src,dst=firstFrame.dst,prio=firstFrame.prio, + dev=firstFrame.dev,hdr=firstFrame.hdr) + self.data="" + self.numFrames=firstFrame.getFPNum(bytes=False) + self.len=firstFrame.getFPNum(bytes=True) + self.finished=False + self.addFrame(firstFrame) + + def addFrame(self,frame:CanFrame): + if self.finished: + return False + if frame.frame is None: + return False + if frame.frame == 0: + self.data+=frame.data[4:] + else: + self.data+=frame.data[2:] + if frame.frame >= (self.numFrames-1): + self.finished=True + return True + + def __str__(self): + return f"{self._formatTs()},{self.prio},{self.pgn},{self.src},{self.dst},{self.len},{dataToSep(self.data,self.len)}" + +def usage(): + print(f"usage: {sys.argv[0]} [-q] [-p pgn,pgn,...] [-w waitsec] [ -f plain|actisense] file",file=sys.stderr) + sys.exit(1) + + + + +FORMATS=[ + Format(Format.N_PLAIN,Format.F_PLAIN), + Format(Format.N_ACT,Format.F_ACT), + Format(Format.N_PASS,Format.F_PASS,False), + Format(Format.N_SEASMART,Format.F_SEASMART) +] + +MAX_ACT=400 +ACT_ESC=0x10 +ACT_START=0x2 +ACT_N2K=0x93 +ACT_END=0x3 + +class ActBuffer: + def __init__(self): + self.buf=bytearray(MAX_ACT) + self.sum=0 + self.idx=0 + self.clear() + def clear(self): + self.sum=0 + self.idx=2 + self.buf[0:2]=(ACT_ESC,ACT_START) + def add(self,val): + #TODO: len check? + val=val & 0xff + self.buf[self.idx]=val + self.sum = (self.sum + val) & 0xff + self.idx+=1 + if val == ACT_ESC: + self.buf[self.idx]=ACT_ESC + self.idx+=1 + def finalize(self): + self.sum=self.sum % 256 + self.sum = 256 - self.sum if self.sum != 0 else 0 + self.add(self.sum) + self.buf[self.idx]=ACT_ESC + self.idx+=1 + self.buf[self.idx]=ACT_END + self.idx+=1 + +actBuffer=ActBuffer() + + +LB=b'0000000000000' +B_STAR=0x2a +class SeasmartBuffer: + def __init__(self): + self.buf=bytearray(500) + self.idx=0 + self.clear() + def clear(self): + self.idx=0 + def addB(self,bv,mlen=None): + l=len(bv) + if mlen is not None and mlen < l: + l=mlen + self.buf[self.idx:self.idx+l]=memoryview(bv)[0:l] + else: + self.buf[self.idx:self.idx+l]=bv + self.idx+=l + def addVal(self,val,blen=2): + hs=hex(val)[2:].encode() + if len(hs) != blen: + hs=(LB+hs)[-blen:] + self.addB(hs) + + def finalize(self): + sum=0 + self.buf[self.idx]=B_STAR + self.idx+=1 + for b in memoryview(self.buf)[1:]: + if b == B_STAR: + break + sum ^= b + sum = sum & 0xff + self.addVal(sum) + self.addB(b'\x0d\x0a') + +seasmartBuffer=SeasmartBuffer() + +def send_act(frame_like:CanFrame,quiet,stream): + try: + actBuffer.clear() + actBuffer.add(ACT_N2K) + actBuffer.add(frame_like.len+11) + actBuffer.add(frame_like.prio) + pgn=frame_like.pgn + actBuffer.add(pgn) + pgn = pgn >> 8 + actBuffer.add(pgn) + pgn = pgn >> 8; + actBuffer.add(pgn) + actBuffer.add(frame_like.dst) + actBuffer.add(frame_like.src) + #Time + ts=int(frame_like.ts) + actBuffer.add(ts>>24) + actBuffer.add(ts>>16) + actBuffer.add(ts>>8) + actBuffer.add(ts) + + actBuffer.add(frame_like.len) + for i in range(0,frame_like.len*2,2): + actBuffer.add(int(frame_like.data[i:i+2],16)) + actBuffer.finalize() + written=stream.write(memoryview(actBuffer.buf)[0:actBuffer.idx]) + if (written != actBuffer.idx): + if not quiet: + logError(f"actisense not all bytes written {written}/{actBuffer.idx} for pgn={frame_like.pgn} ts={frame_like.ts}",keep=True) + stream.flush() + return True + except Exception as e: + if not quiet: + print(f"Error writing actisense for pgn {frame_like.pgn}, idx={actBuffer.idx}: {e}",file=sys.stderr) + return False + +BK=b',' +def send_seasmart(frame_like:CanFrame,quiet,stream): + try: + seasmartBuffer.clear() + seasmartBuffer.addB(b'$PCDIN,') + seasmartBuffer.addVal(frame_like.pgn,6) + seasmartBuffer.addB(BK) + seasmartBuffer.addVal(int(frame_like.ts),8) + seasmartBuffer.addB(BK) + seasmartBuffer.addVal(frame_like.src) + seasmartBuffer.addB(BK) + seasmartBuffer.addB(frame_like.data.encode(),mlen=frame_like.len*2) + seasmartBuffer.finalize() + written=stream.write(memoryview(seasmartBuffer.buf)[0:seasmartBuffer.idx]) + if (written != seasmartBuffer.idx): + if not quiet: + raise Exception(f"seasmart not all bytes written {written}/{seasmartBuffer.idx} for pgn={frame_like.pgn} ts={frame_like.ts}") + stream.flush() + return True + except Exception as e: + if not quiet: + logError(f"writing seasmart for pgn {frame_like.pgn}, idx={seasmartBuffer.idx}: {e}",keep=True) + return False + +class Counters: + C_OK=1 + C_FAIL=2 + C_FRAME=3 + TITLES={ + C_OK:'OK', + C_FAIL:'FAIL', + C_FRAME:'FRAMES' + } + def __init__(self): + self.counters={} + for i in self.TITLES.keys(): + self.counters[i]=0 + def add(self,idx:int): + if idx not in self.TITLES.keys(): + return + self.counters[idx]+=1 + def __str__(self): + rt=None + for i in self.TITLES.keys(): + v=f"{self.TITLES[i]}:{self.counters[i]}" + if rt is None: + rt=v + else: + rt+=","+v + return rt + +def writeOut(frame:CanFrame,format:Format,quiet:bool,counters:Counters): + rt=False + if format.key == Format.F_ACT: + rt= send_act(frame,quiet,sys.stdout.buffer) + elif format.key == Format.F_SEASMART: + rt= send_seasmart(frame,quiet,sys.stdout.buffer) + else: + print(frame.printOut(format)) + rt=True + counters.add(Counters.C_OK if rt else Counters.C_FAIL) + return rt + +def findFormat(name:str)->Format: + for f in FORMATS: + if f.name == name: + return f + return None + +if __name__ == '__main__': + try: + opts,args=getopt.getopt(sys.argv[1:],"hp:qw:f:") + except getopt.GetoptError as e: + logError(e) + pgnlist=[] + quiet=False + delay=0.0 + format=findFormat(Format.N_PLAIN) + for o,a in opts: + if o == '-h': + usage() + elif o == '-q': + quiet=True + elif o == '-p': + pgns=(int(x) for x in a.split(",")) + pgnlist.extend(pgns) + elif o == '-w': + delay=float(a) + elif o == '-f': + format=findFormat(a) + if format is None: + logError(f"invalid format {a}, allowed {','.join(x.name for x in FORMATS)}") + if len(args) < 1: + usage() + hasFilter=len(pgnlist) > 0 + if not quiet and hasFilter: + print(f"PGNs: {','.join(str(x) for x in pgnlist)}",file=sys.stderr) + counters=Counters() + with open (args[0],"r") as fh: + buffer={} + lnr=0 + for line in fh: + lnr+=1 + frame=CanFrame.fromDump(line) + if frame is None: + continue + if hasFilter and not frame.pgn in pgnlist: + continue + counters.add(Counters.C_FRAME) + if frame.sequence is None or not format.merge: + writeOut(frame,format,quiet,counters=counters) + if delay > 0: + time.sleep(delay) + else: + key=frame.key() + mf=buffer.get(key) + mustDelete=False + if mf is None: + if frame.frame != 0: + if not quiet: + print(f"floating multi frame in line {lnr}: {frame}",file=sys.stderr) + continue + mf=MultiFrame(frame) + if not mf.finished: + buffer[key]=mf + else: + mf.addFrame(frame) + mustDelete=True + if mf.finished: + writeOut(mf,format,quiet,counters=counters) + if mustDelete: + del buffer[key] + if delay > 0: + time.sleep(delay) + if not quiet: + print(f"STATISTICS: {counters}",file=sys.stderr) + \ No newline at end of file diff --git a/webinstall/build.yaml b/webinstall/build.yaml index 0fcca66..0234010 100644 --- a/webinstall/build.yaml +++ b/webinstall/build.yaml @@ -53,16 +53,16 @@ types: - value: M5_ENV3#grv# key: true resource: qmp69881#grv#1,sht3x#grv#1 -# - label: "M5 ENV4" -# type: checkbox -# key: m5env4#grv# -# target: define -# url: "https://docs.m5stack.com/en/unit/ENV%E2%85%A3%20Unit" -# description: "M5 sensor module temperature, humidity, pressure" -# values: -# - value: M5_ENV4#grv# -# key: true -# resource: bmp280#grv#1,sht3x#grv#1 + - label: "M5 ENV4" + type: checkbox + key: m5env4#grv# + target: define + url: "https://docs.m5stack.com/en/unit/ENV%E2%85%A3%20Unit" + description: "M5 sensor module temperature, humidity, pressure" + values: + - value: M5_ENV4#grv# + key: true + resource: bmp280#grv#1,sht4x#grv#1 - type: checkbox label: SHT3X-1 description: "SHT30 temperature and humidity sensor 0x44" @@ -179,6 +179,11 @@ types: description: "M5 Gps Unit" url: "https://docs.m5stack.com/en/unit/gps" resource: serial + - label: "Gps Unit v1.1" + value: M5_GPSV11_UNIT#grv# + description: "M5 Gps Unit v1.1" + url: "https://docs.m5stack.com/en/unit/Unit-GPS%20v1.1" + resource: serial - label: "RS232/RS422" value: SERIAL_GROOVE_232#grv# description: "Generic RS232/RS422 Unit (bidirectional)" @@ -234,6 +239,46 @@ types: - 37 - 38 + - &gpiopinvs3 + - {label: unset,value:} + - {label: "0: boot mode control",value: 0} + - 1 + - 2 + - {label: "3: JTAG control", value: 3} + - 4 + - 5 + - 6 + - 7 + - 8 + - 9 + - 10 + - 11 + - 12 + - 13 + - 14 + - 17 + - 18 + - 19 + - 20 + - 21 + - 33 + - 34 + - 35 + - 36 + - 37 + - 38 + - 39 + - 40 + - 41 + - 42 + - 43 + - 44 + - {label: "45: strapping pin", value: 45} + - {label: "46: strapping pin", value: 46} + - 47 + - 48 + + - &gpioinput type: dropdown resource: "gpio:" @@ -275,12 +320,39 @@ types: - &protogpio - {label: unset,value:} - - PPIN19 - - PPIN21 - - PPIN22 - - PPIN23 - - PPIN25 - - PPIN33 + - {label: "PPIN19(left-2,gpio 19)", value: PPIN19} + - {label: "PPIN21(right-1,gpio 21)", value: PPIN21} + - {label: "PPIN22(left-1,gpio 22)", value: PPIN22} + - {label: "PPIN23(left-3,gpio 23)", value: PPIN23} + - {label: "PPIN25(right-2,gpio 25)", value: PPIN25} + - {label: "PPIN33(left-4,gpio 33)", value: PPIN33} + + - &protogpios3 + - {label: unset,value:} + - {label: "PPIN19(left-2,gpio 6)", value: PPIN19} + - {label: "PPIN21(right-1,gpio 39)", value: PPIN21} + - {label: "PPIN22(left-1,gpio 5)", value: PPIN22} + - {label: "PPIN23(left-3,gpio 7)", value: PPIN23} + - {label: "PPIN25(right-2,gpio 38)", value: PPIN25} + - {label: "PPIN33(left-4,gpio 8)", value: PPIN33} + + - &baudselect + type: dropdown + help: 'Select the baud rate' + values: + - {label: unset,value:} + - 1200 + - 2400 + - 4800 + - 9600 + - 14400 + - 19200 + - 28800 + - 38400 + - 57600 + - 115200 + - 230400 + - 460800 - &serialRX <<: *gpioinput @@ -294,6 +366,33 @@ types: help: 'number of the GPIO pin for the transmit function' target: "define:#serial#TX" mandatory: true + - &serialEnablePin + <<: *gpiopin + key: ENA + label: "enable pin" + help: "GPIO pin for output enable" + target: "define:#serial#ENA" + mandatory: false + - &serialEnableLow + type: checkbox + key: ELOW + label: "enable low" + target: "define:#serial#ELO" + default: false + help: "set: low on enable pin for output, unset: high on enable pin for output" + values: + - key: true + value: 1 + - key: false + value: 0 + + - &serialFixedBaud + <<: *baudselect + key: fixedBaud + label: "fixed baud" + help: "you can set a fixed baud rate here, this disables changing the baud rate in the UI" + target: "define:#serial#BAUD" + - &serialValues - key: true children: @@ -310,6 +409,9 @@ types: children: - *serialRX - *serialTX + - *serialEnablePin + - *serialEnableLow + - *serialFixedBaud - key: bi value: 2 label: "BiDir" @@ -318,18 +420,25 @@ types: children: - *serialRX - *serialTX + - *serialFixedBaud - key: rx value: 3 label: "RX" description: "Input only" children: - *serialRX + - *serialEnablePin + - *serialEnableLow + - *serialFixedBaud - key: tx value: 1 label: "TX" description: "output only" children: - *serialTX + - *serialEnablePin + - *serialEnableLow + - *serialFixedBaud - &serial1 type: checkbox label: 'Serial 1' @@ -664,13 +773,18 @@ types: label: "Gps Base" url: "https://docs.m5stack.com/en/atom/atomicgps" resource: serial + - value: M5_GPSV2_KIT + description: "M5 Stack Gps Base v2.0" + label: "Gps Base" + url: "https://docs.m5stack.com/en/atom/Atomic_GPS_Base_v2.0" + resource: serial - value: M5_PROTO_HUB description: "M5 Stack HUB PROTO" url: "https://docs.m5stack.com/en/atom/atomhub" label: "Hub Proto" base: - gpioinputv: *protogpio - gpiopinv: *protogpio + gpioinputv: "#protogpio#" + gpiopinv: "#protogpio#" children: *m5protochildren - value: M5_PORTABC @@ -689,6 +803,13 @@ resources: config: children: + - type: string + label: 'Build Name' + key: buildname + target: "define:GWBUILD_NAME" + help: "Set a name to identify your build. Will also become the name for the generated files and the firmware type in the image. Max 31 characters." + max: 31 + allowed: "0-9A-Za-z_-" - type: select target: environment label: 'Board' @@ -697,6 +818,7 @@ config: gpiopinv: *gpiopinv gpioinputv: *gpioinputv grv: "" + protogpio: *protogpio values: - value: m5stack-atom-generic label: m5stack-atom @@ -711,6 +833,8 @@ config: description: "M5 Stack AtomS3 light" url: "http://docs.m5stack.com/en/core/AtomS3%20Lite" resource: *esp32default + base: + protogpio: *protogpios3 children: - *m5base - *m5groove @@ -725,7 +849,7 @@ config: - value: nodemcu-generic label: nodemcu - description: "Node mcu esp32" + description: "Node mcu esp32,4MB flash, no PSRAM" url: "https://docs.platformio.org/en/stable/boards/espressif32/nodemcu-32s.html" resource: *esp32default children: @@ -746,6 +870,38 @@ config: base: busname: "1" bus: "1" + - <<: *spisensors + base: + busname: "2" + bus: "2" + + - value: s3devkitm-generic + label: s3devkitm + description: "esp32 s3 generic, 8MB flash, no PSRAM " + url: "https://docs.espressif.com/projects/esp-idf/en/latest/esp32s3/hw-reference/esp32s3/user-guide-devkitm-1.html" + resource: *esp32default + base: + gpiopinv: *gpiopinvs3 + gpioinputv: *gpiopinvs3 + protogpio: *protogpios3 + children: + - *serial1 + - *serial2 + - *can + - *resetButton + - *led + - <<: *iicsensors + base: + busname: "1" + bus: "" + - <<: *iicsensors + base: + busname: "2" + bus: "2" + - <<: *spisensors + base: + busname: "1" + bus: "1" - <<: *spisensors base: busname: "2" diff --git a/webinstall/cibuild.js b/webinstall/cibuild.js index 690da1d..285bacc 100644 --- a/webinstall/cibuild.js +++ b/webinstall/cibuild.js @@ -167,8 +167,17 @@ class PipelineInfo{ updateStatus(); if (gitSha !== undefined) param.tag=gitSha; param.config=JSON.stringify(config); + let buildname=config['root:buildname'] + if (buildname){ + param.suffix="-"+buildname + } if (buildVersion !== undefined){ - param.suffix="-"+buildVersion; + if (param.suffix){ + param.suffix+="-"+buildVersion; + } + else{ + param.suffix="-"+buildVersion; + } } fetchJson(API,Object.assign({ api:'start'},param)) @@ -234,7 +243,11 @@ class PipelineInfo{ } const downloadConfig=()=>{ let name=configName; - if (isModified) name=name.replace(/[0-9]*$/,'')+formatDate(undefined,true); + const buildname=config["root:buildname"] + if (buildname && name != buildname){ + name+="-"+buildname+"-"; + } + name=name.replace(/[0-9]*$/,'')+formatDate(undefined,true); name+=".json"; fileDownload(JSON.stringify(config),name); } @@ -521,6 +534,38 @@ class PipelineInfo{ addDescription(config,inputFrame); initialConfig=expandedValues[0]; } + if (config.type === 'string'){ + let ip=addEl('input','t'+config.type,inputFrame); + addDescription(config,inputFrame); + const buildChild=(value)=>{ + if (value) { + if (config.max) { + if (value && value.length > config.max) { + value = value.substring(0, config.max); + } + } + if (config.allowed) { + let check = new RegExp("[^" + config.allowed + "]", "g"); + let nv = value.replace(check, ""); + if (nv != value) { + value = nv; + } + } + } + return Object.assign({},config,{key: value,value:value}); + } + initialConfig=buildChild(current); + ip.value=initialConfig.value||""; + ip.addEventListener('change',(ev)=>{ + let value=ev.target.value; + let cbv=buildChild(value); + if (cbv.value != value){ + ev.target.value=cbv.value; + } + callback(cbv,false); + + }); + } let childFrame=addEl('div','childFrame',frame); if (initialConfig !== undefined){ callback(initialConfig,true,childFrame); diff --git a/webinstall/config/m5stack-atom-gps_v2-canunit.json b/webinstall/config/m5stack-atom-gps_v2-canunit.json new file mode 100644 index 0000000..e7f13be --- /dev/null +++ b/webinstall/config/m5stack-atom-gps_v2-canunit.json @@ -0,0 +1 @@ +{"root:board":"m5stack-atom-generic","root:board:m5lightbase":"M5_GPSV2_KIT","root:board:m5groove":"CAN","root:board:m5groove:m5groovecan":"M5_CANUNIT"}