From 639b5df5640029e74c778222797acf495b36180f Mon Sep 17 00:00:00 2001 From: YunHorn Technology Date: Fri, 24 May 2024 19:08:56 +0800 Subject: [PATCH] try lowpower ,disable PME_OFF and GPIO_DeInit of A/B/C --- Core/Src/gpio.c | 2 +- Core/Src/stm32_lpm_if.c | 13 +- LoRaWAN/App/lora_app.c | 4 +- STM32CubeIDE/Release/STS_RR_R125.bin | Bin 85576 -> 85440 bytes STM32CubeIDE/Release/STS_RR_R125.hex | 9677 +++++++++++++------------- STM32CubeIDE/STS_RR_R125.launch | 6 +- TOF/App/app_tof.c | 3 +- TOF/App/app_tof_vl53l0x_range.c | 16 +- 8 files changed, 4863 insertions(+), 4858 deletions(-) diff --git a/Core/Src/gpio.c b/Core/Src/gpio.c index bd118f7..24ead0d 100644 --- a/Core/Src/gpio.c +++ b/Core/Src/gpio.c @@ -146,7 +146,7 @@ void MX_GPIO_Init(void) HAL_GPIO_Init(TOF_C_XSHUT_GPIO_Port, &GPIO_InitStruct); #endif /*Configure GPIO pins : TOF_L_XSHUT_Pin */ -#if (defined(TOF_2)&&!defined(TOF_1)) +#if (defined(TOF_2)&&defined(TOF_1)) GPIO_InitStruct.Pin = TOF_L_XSHUT_Pin; GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP; GPIO_InitStruct.Pull = GPIO_PULLUP; diff --git a/Core/Src/stm32_lpm_if.c b/Core/Src/stm32_lpm_if.c index 58ede99..c1cb96d 100644 --- a/Core/Src/stm32_lpm_if.c +++ b/Core/Src/stm32_lpm_if.c @@ -81,31 +81,34 @@ const struct UTIL_LPM_Driver_s UTIL_PowerDriver = void PWR_EnterOffMode(void) { /* USER CODE BEGIN EnterOffMode_1 */ +#if 0 PME_OFF; HAL_GPIO_DeInit(GPIOA,GPIO_PIN_All); HAL_GPIO_DeInit(GPIOB,GPIO_PIN_All); HAL_GPIO_DeInit(GPIOC,GPIO_PIN_All); HAL_SuspendTick(); HAL_PWR_EnterSTANDBYMode(); - +#endif /* USER CODE END EnterOffMode_1 */ } void PWR_ExitOffMode(void) { /* USER CODE BEGIN ExitOffMode_1 */ +#if 0 HAL_ResumeTick(); return; +#endif /* USER CODE END ExitOffMode_1 */ } void PWR_EnterStopMode(void) { /* USER CODE BEGIN EnterStopMode_1 */ - PME_OFF; - HAL_GPIO_DeInit(GPIOA,GPIO_PIN_All); - HAL_GPIO_DeInit(GPIOB,GPIO_PIN_All); - HAL_GPIO_DeInit(GPIOC,GPIO_PIN_All); + //PME_OFF; + //HAL_GPIO_DeInit(GPIOA,GPIO_PIN_All); + //HAL_GPIO_DeInit(GPIOB,GPIO_PIN_All); + //HAL_GPIO_DeInit(GPIOC,GPIO_PIN_All); /* USER CODE END EnterStopMode_1 */ HAL_SuspendTick(); diff --git a/LoRaWAN/App/lora_app.c b/LoRaWAN/App/lora_app.c index ea0fc22..e464ae7 100644 --- a/LoRaWAN/App/lora_app.c +++ b/LoRaWAN/App/lora_app.c @@ -812,7 +812,7 @@ static void SendTxData(void) //UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_YunhornSTSEventP6), CFG_SEQ_Prio_0); #if defined(YUNHORN_STS_R0_ENABLED)||defined(YUNHORN_STS_R5_ENABLED) //UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_YunhornSTSEventP4), CFG_SEQ_Prio_0); - + MX_TOF_Process(); STS_R0_SENSOR_Read(&r0_data); //r0_data.battery_mV = batteryLevelmV; r0_data.battery_Pct = (uint8_t)(99*batteryLevel/254); @@ -919,7 +919,7 @@ static void OnTxTimerEvent(void *context) /* USER CODE END OnTxTimerEvent_1 */ //upload_message_timer =1U; - UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_YunhornSTSEventP4), CFG_SEQ_Prio_0); + UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_LoRaSendOnTxTimerOrButtonEvent), CFG_SEQ_Prio_0); /*Wait for next tx slot*/ diff --git a/STM32CubeIDE/Release/STS_RR_R125.bin b/STM32CubeIDE/Release/STS_RR_R125.bin index 5362f720889ce13fe0b1384b85560b0ca3abd205..2424dcbd152d3fd971809a509c039986915bdf47 100644 GIT binary patch delta 6678 zcmb_hd3aPswy$%0yIGp3k&+Cab&ktH%nLK|Yh5RnmKkQpM2W)J}p0-|ywf!q6?b2~7@yl=km{qw^2>vQVV zsZ*z_&Z*^cVyoiwYDE zQ1+0{{4aImP&PT4RQ=1qLuIMYhy4F1ef1G19*(PVNY=kcu;dYi|GQ&45RA-;EII+Y zBXP}z4Js&hg@yeJFv=x_D;OxFfyfu2JDsXNtFHAEqkMzapxE;m{}CgG>09umoPSM}WV?NlHU)pqE%DoZrM#HI+T?r}QHjze z9tHAKL^&tJQld-fX#&#@PZzy{|Hea%QJe<3YL7-QtDWeU-&XKnH4?(sEBI|RU$2Ah zbfP{17SSd8lBl13`Z^}%@#a}P$RSa|PoWp}l@LQm7$!4rFReAqjp2fq-K*A<&8==? zIdwOj#18%FfR@jtc}6pH&P!i5Rxq~%^atZBkV!`*q*ndtg_>0K>j$Kz{CcZ`Z}pb) zwFN2M*_RV|x$NvTy#b60zQYH`(hgGDsq?Fk(Tl=oB5Nq^kaxwI=&Iu6>!BuvgCyBT z1>fLBpRt5B15e+QO;hk6d$IML&OZJv-I46oKC1XX3Vw^%$QigWy_~NRrQh#FRW08{ z*~FCi_<%IOH{Gm_7!>@wL8)}rtq7Is>4?PCh*6#_BQdahqIf%9k{H9>_R%egIgm=v zCuTxD4KtbHJvzvgq50Mwi;4^?e&bf~9Gzz>hAp(&r0bL9W$R`i47TZ{)$pDnOq|O6)PgZFI!hw-oeg zDeYLC$xvnw(m5KcABJ`E+mIiMJc}mc4t46TJN!^r$uGqE z&#;~O7GJo!b}>iv+V@oJS98%^FD@Vy1o%en@YA=*`qQ@)RdA8&(RSn=^69HTJPe!&xTEXRUVpw^=NomHn7*#I0746&nC#qlzdL0Gap5v zjqXcH&YKtL_aJG|^(I0hKT*{yhAH-H4M4Sg_h4s2F||0<=6BJWrG9y>oMZN=IW0ek zMy1A-zaB_gtf;j#NwrecYwM{ap@S6CGA+N;ueL*Cj|we6+Y@2a@~b@&c8uYI?vrt- z{3@LHpqKEUxV8L3uYuEZO*gexE&uMJ6X^TS6x`6QlpVZBLz?TH%(XWR82NRnE`F-#%qo(kfSoy}-a=U-Cm3sz?cay?3&D zsaIv+QD(iX(FcVabbs#>$fcg%Ghr>Ao)(|7@xc-?92lhKUHhP{tzTQ)2SZ-Y!5%Ho z2k4*EQdH#_>!L7F_He4;PvCwm3UAZ#=AzVK0OKaKtKl9rNb!!GzZYQb*QT5Fy}1l->l8T; zJ`?7hg??quNLUoSGE2_i@JZ_^N#hS=E@J;|eK-dkgLC;j)%7(%KF#Z^OI_eomdI^j zRPjH1iJl2X?FsZ)^7;&dtykG&%S7QPx}@(AI7*N99i6t}P$;|6rlcupF=#<+kn0>EqO<@993JlWdScM|EI8@EUUzgZY0f;*A-|d5@A7J#T%QYoEC*}znoL0^HY5aZdDyg%*6(`-MRK` zo6fPdz`$iS$6?CP@C-n?*&`)9@L_IxAj6R$_dyENqQ~m(?jH7Tw$}Ls*EGSWwA8ey z_&Z)Xw~OZWtAvl}{(dp4fk8EzsHUg;r9w|C^h=HoKO(Jw2=?;HIx^* z3@silT}5RWD}V=~o9?#SGry5;{&@Dt_yqw2O8@GI2j$98`3t|ElQd*}d7!kzR1p*! zsVRSF^kd>Q)SilWy134Z6PDEUa{fz@u~KK>I{QjuHuodE->Had+v@B)UMl8-%>!4>-F+k zkbFVJjYHbR@!XW@3ICKI_>_PWj}DFACp6)sA-2&c45d*oy#(7`i(b+&_!L+-b1aN? zU7Z=vXodz9T!N$8@vQ3hd7qF+)fMv?2+$Q3J)xcMtZ31!@^>m+R9#1fC3JbE3!Zjm z&o%*Uq?6|Kf@Q9%IlJXxp~>@8)jAK+?J2l_R({1NM7t)=-z$e^8n(!+*%MT9X^!gh zYUKy#yux-`v}gppM(Lsw7)LKH+6*k6_eL@NM4R8p$Bv<@0j9eetI_~kT-O&L26eJq zU#D%VR=_!&W4do?f~#Zca{y*KdRcsIPv2r4lk!`uO#gcuY0kp=-GsQ3MOQ5Q5wd9c z@?>UH4&AVP8Q5sdiXup+6IaZOzwJ?R7u*{yn^o5Kor}G~HP10!RNB2(`4z8liMFqZ z)_j8+qEHkhDUD~m!YLZPa)@ScNEVB-cUru{hji-7^r*EVnI}L}hIGu`?-iEO9V_$I zQ&F1fn4nPLfG5)Sl?fVqNb;Rt|N4W$XI(lvcNO72_qVv8yk^-Of~s+jCJ)RR1` zRw>SVg~vjE-EYloOK?1+dh&ckX|AJH@%TAWfPhz!Vf$RiKNOMJIza1I<-%q9>#F#e zGwx%$!lL`F?KiGDq<7eoG#&c;B{i&0Q}1_wuCo@kx1PD-6>8}C)duyZkmP=ABT6>V zm8;|7O}cZn!8{wSxC-vKQk1_O(z)Ea?nb0}O)MeYmRCqoG1FMCXcX{&Uq^pR?=;6#lY*d{;hd1)n#74jbW4l`t^oC zgUhvmo>IVmTC{mkSYQ)=vDr-6(RBIdB6ydc+I$|e>GmyO!Ufm#>PyhQ&0X5IrM!S= znJtrF#;6a9;vKS>ShsCmg!+&3${eJ7rhTB1L_i{98b z*EoJRVaI<&*qI*__TDbS{-h!L5x)|4Fsd9y)z+P^H$MKEVOsaQX4H*gm|wD7M_k7l zW?=zcaj-9x(E5YPFrHpIXoqr|+F-|zHm^3^3Dv)NXo95n#i0vGTw4xr0EzZ(`Vopw zA0e!OxYtbB_|FMjjW~)(K1$e9#CgOdte24b#lQI$AZ>LCuaOM0%8KMQ>2W3*Z;7V^9LvvlPT=Paq&1T#g6J9nLSStdnkKe&3 z-T>rH2s0wqFN)-6<)AH_!>m>zY*0v-n%nO}EH(Vz7S`Dg*fJV*_hPi6@RZV8k7#}d;?^A(x z!RD9oKls~)#DHsS@Owx)hejNTl?Z&A+wpqFowYo z(yBKw5pW2?ZB}4cApT-)I35Xo8Q>c3b%8K|=bfSkHb))pg=0i3HpBomu;UtPv{0>7 zTJYjLzo21Q41B{pC^(JXVFL7OSkxWbfVr9Pe6a`IP|U|k8s0EE9{$dx2G9lkC}VqQ z@H;fR6%mCx-4TfhGh(2#L=P{(mWKU$CSJn*_^&I*%qnBct^?7be5YV0GR~hErf| zs84}e5Yu>wNqfAR|}w)mcy|$4e%0j>>|h@cRK` zBniI>Np9!jEa)Hp?Srz)?L3kNiSW7eS{9hX_Jzd13YVNw*>KkMB)adfB16ak==zt( z2-^!kaVrqFk_a1y^g7ZEXIKvO8X2EP*d~M-aT2i(aULPLkcaeMZ``903lJ@c>xkuu z)rf6~xW4#*1Bfrpxbv7B=H|c+rdu=S%TdH#^y3)P7R0H+4YTuLsl4hpOa(yeBcHZU z@*yvEh5T3+BR35B{86LEMk61N{Lq4uNk-%&kRMSv=E-#A@yU(6y=XA<>Q3HLf_xW= z&mSA&H4;B^tmP?`YmuK&G^R8GqkhcfY0fzX@OITY4X~rT0J~ZX>}jOi<4d83%q9Vu~W=L<3A delta 6837 zcmb_gdtB7jw%_YFuOA@Hj0A$9&I}-ofb#GGs5yZA07nl#D%0`=nKe`<mfV6`J8a`^Y*_k6^pTyHU|c6DWp7DluJqfy#Q7)@)m z7xb6CCR?N}SI}N65ORdBtc_09<-%ddPTe@*9`RD2zCT=dWOmhe30ohCX=uLATL`;A zNA;Xi^t+pHAZ({sU!vFmyHDMK$CT_7NtSK#b}3OYKG<*fmN6-lFHy1rNsUscTZQ~a zNhv6>^`t}WnFL8^-4O;AQ+tR>FKChb&aE{l>L;#?J!hx}D;;I5;L^Ob-Z-nSyQ_@ENJOdyC}ybG6_4&=$#W{!<}nGzNFl_aWY?t-j6pY-rk*vE78;+J(&H(=9M|hEzJwT6 z?1zBdy6jQ~TX$$hqB-#ccaDh|`CWQe=k8<6ux>7Rsf5IweWm8IVMmPZC2U!gxPn;eOh^cb|w3AKxH}*Cl0% znsp1%vAq-H_qa^9SadS2wd`(fHb*&hvv#@`-7NLe^}RD{)&w{VMRS0d`WW^Bgrf5HLl1P-Y(4fL#&PL4SmE;eT7ejJ?`hU87ovn- zf?w=Pwgfu8U8_UCHKo*E!BH!?>rSUd8RTL*>yO!OCIpo!qLeR-pMB@%GGSN zzccqGaUUI(l05Wvf7bm3Memvk>GHY8sT!f$t1|-Cv5Y`x@^bZ6#iXStTFY=QsaFcz zu5dxeM$v|pZk1MlO0B9sqgn2iGfd~CwuHN+ke2J%Az!!^6633MY?(W(M91EDhgmV( z3c6R|YS?=i+HXCCeeTk+^&X>O5ag}Uv5ya)K;Knn+*b>EQpXM+WP9mb<_hx+ml7qjUBfL(_8R`CmFLKtSta!XBZqT!KZuEeG@8cs zNe&aTkdEL0dYSq>r)D0bW@+Hu#IX`d!+2SzYClIMtN7Z-EZrhtLoD*!IT2* z(lK>_j!aF_)L;%tVl;g{)d(}`mei#1XAgC5HyG9IY5HAiH{%t|q{R~EMYTatvs65d z$&=OWh9?V`%%N5;)ubgsK21-H>#09Xh|Z}V$r)wc7%yimi0=%HnuQ*s&!?rmpzz95 zF7?SZM8m3sIa%vdmS~vO_h5JD9OiNT{lkcX3?~-mwBxQlg1#%z^8$Zoh0(F0ev{3F z$!lrlf)&PK4W%k}5le<7j;HRlA~P4ja}%tfSnmd@-c~ZVpSNCpA<583$Q0gvR>@S} zB+Tdj^o8`ygav_1)0FHtue^`4)OZMU9Ovhqp#lgT#&QNdlx~Fa^g?=^d97Dnsw@GM zh7m6@aKTf10zHt2okG z4Y(2#Y)_yU`c48J9o#Ry+Z;TbKLssfX_G>+#!vJEdxX~XOE$Wj<+Cl_J$NJ0C=V^H<6YS%rRmFgO$azx6!6VT~)Ahamal|`(?yMzKC))wtmNQqO&NF`;<<~=mlfw z{ES{T$vB73BA;6=Gh#Kkiz~Q-Gks1lHVBMqsU#jhK$wEhadyGcDQ*q>EKuGQIx@5b zl9H-4Y?$9L$1G?V^~m!-kMrbMWUk`A*Hvhz3nByUYFJi_oZphD^eF{RDx273PulhSbd)2rk;!^NXYB6cqJ$keMC{3k5!zPJu&|w2gu@)>JkQ?@u%VNqbwFz3b zgq|8;gm`*;Kts(TuVOdgW;J?qa7V}nlTdcoQ>|rZ{R6E7A8LQ+?{DpoZTW&D_kZm- zpa(x;xd@1pq<&Vifyg}-=@^72fBJ~d1N^x!6*>9Hed_CjoD#V`z7*tmqbZ97_iS7JJlr$IE^dRC?WX=g zaj=BO=A?%$mP`V-TaWG>pks3O6>V@??j6XG#C0xxee?AUybYW^JT5(=wHA+X18T+K z&FMKQ|Bq#;^M>o=5m8tYmRu@Kk8UN2Het1kSTt-IEzBLJ|22@DkW>Xp+pDfsB~=H+ z6O`tD9r;?oCP-qwf3npmOgF{gzE{(!dDGxkdLb_shEp-mtncr+(Ox?zH|6$E897Hk zlf+D#Ik;F+>WQUehQ!g0g9UC;9=$lY3hvReA$EK^v=5mJ&9q|Ze0(naGBjWNy`Ln8 zcWB6Jm&T%IT^;=%t%Rtn-hkNQ3AD>EIegd{4)esYitZaWKPnKsAlHtOFUShE(+~K` zyi12!tl8hn?-Be;DcD@U5v5DP&L+xjL zgvEB=qOcW0XXn2JCdbwMsh~fAsq``814JF-9a>TNrLiZf1w3`Gn2fpxcr=NdP` zzBawsm6##-F-P%mdk7qG{4&ZB0V^Ez>Dy}PdEodmFsim T1U6( zJC%?|TV|WXySYi+u7Z2tD=&FPz2nc>dzEmAZk?B|{V<>wQf+mWb?R+Dc*HIA!n{#1 zi>A&m4I2}v#Ubz$N&hce@kSgSJwJl(n*Tf~srHRxxJ1Xlkq-{K>5WF1>=;v%3UJCX zzxEJ>=ei6Hy5>3+{6JVLEn1imuO1O;OJEvBAyX(K%atP{D+}>i6j_ncQdR6IU-%ph z?BDW>05l^|lh|{P3*`~bY5x;gH zMT-u!xVF8!&BTD~UhWYO;|NJC3Xqhh(;hrQ%ikQPeLE}3&id3NzCyb#%?}@i(rnvAl?vlnOs6bO&<+Sno>JBPnTJ|^seNg`fzfWYa2CDV ztcgKAt$PvrbgxZlmpx5jp!f=@M^xZQSyHD_o$-i17xgWT(ckuY#9J=4Fxd99stXQo zr%B5O!#A{ISr0f!YnDa9r}XV*so|SkN8>C-9c`z7^@x<7T4oGi7?j*=YeLC9>P7vj zGo#O8_SnwACuI=A=^1c><@17khCa{OBLJnm$HM~9#)uL?iTAMIXvj*&#f?qzaF$z7nIDTAuAKYCkG`Hf|5xzcV#*j zs25fyMP;K+hwWLk+C|~GxlsE9+BMUyE3@@l9FcH;wgV{D&}%ERIWm}bU)574d8?jK zHF(@2Mr>6vtfUuKrNT@{$Z8F69e&z%%{$OY_pV9Rufa6DYO7Pj8Dhw3c8hP)_BCdx zruwzrU6rQ6V1P>6@O~^jO;5gmj4K~Z*L-juWAf709bAW(cHQ<0ggF*$D~9l< zI>J|MA-rttPkLtiB6TgM&YZ#YuOI#u>Kx4<-c%I5kDs+oh<*PCCwKj;oIa!@k9h!x zBS_W#^8QC1sx@JA$$h(qf^rrQo*fuad5gkOYMaFp=75y{60KMLVMoI_Onjqo>* zbi(-%Kj{m?FF`aTIvn2|ImvNuFWq=7j|&^(`1`RRRq_mbzK#en&pb}}q0Oj`nCc|_ zf8u(Sg}|pb68`dj3_Z%4kiJDPpB@)9ym5KcslPm;)Q>Oq?~g;*?N$e^Gu z-OBF32lVZZ_K?nTz+b0J{x}yUduT}{23ZSBCXp>PJ7(U|Lb%)|i-%zM3CCM^3xn?b zD1HX&sVGh#;#lK;UK#(5AA}U4LyYtr@mJ^X5ILWMo%eN!7kv(0;5_txdMNM=M`)4a zQ{Q^(27%5iILFF5pZng_q0X)_OUca`*0@3mf8#=D3coA$Y@C&tx|eg-I9p8d zlWD{-B+p)u1zFKUun+G|2oqJvpR%vS6%C16eRprW3Q_6Pbqg zhb);s+8-7oZTwq*hyZA4Y#jjoAawL_;O8O654VR7f)Y4jA2$e$;fsrae}HB71%sf_ zeqs>x4*kqeOeEo!ctx_i20{N&dcXaJWFMFVi7?OpR1PGCRNfbFvM!|7E=OnMKIUQz1WY9r7W_=Z_veZVU3E$PX_leP$2xVaSgv9Q#-!^7t}G-dc1V z`S4CYqZRoGna>{=vQLaONV$s;Ly?EfqRy=3FnGbK(#Oi>*5CMFY9=+3I zt>}(Up=?4o;9H}x!e9zk#sj|_<+rf^4C*dHItdYl2t$OUECiuJUV+$$X-V8}d8wnU?z~;nR^fBT^AF5t)dg2y=Ght3|-^#@GhJm)7G(A{HQI S1M - + - + @@ -67,7 +67,7 @@ - + diff --git a/TOF/App/app_tof.c b/TOF/App/app_tof.c index fc1d460..2d9959a 100644 --- a/TOF/App/app_tof.c +++ b/TOF/App/app_tof.c @@ -127,7 +127,8 @@ void MX_TOF_Process(void) #if defined(YUNHORN_STS_R0_ENABLED) void STS_R0_SENSOR_Read(STS_R0_SensorDataTypeDef *r0_data) { - + r0_data->distance_mm =0; + r0_data->distance1_mm =0; r0_data->distance_mm = (uint16_t)sts_tof_distance_data[0]; r0_data->distance1_mm = (uint16_t)sts_tof_distance_data[1]; // r0_data->distance2_mm = (uint16_t)sts_tof_distance_data[2]; diff --git a/TOF/App/app_tof_vl53l0x_range.c b/TOF/App/app_tof_vl53l0x_range.c index 5b33c30..86a6b8c 100644 --- a/TOF/App/app_tof_vl53l0x_range.c +++ b/TOF/App/app_tof_vl53l0x_range.c @@ -44,7 +44,14 @@ * @defgroup ErrCode Errors code shown on display * @{ */ +#ifdef STS_R1D //short, accuracy ranging for jumbo sensors #define STS_MAX_L0_RANGE ((uint32_t) 1000) +#endif + +#ifdef STS_R5 //long distance for waste bin sensor +#define STS_MAX_L0_RANGE ((uint32_t) 2500) +#endif + #define ERR_DETECT -1 #define ERR_DEMO_RANGE_ONE 1 #define ERR_DEMO_RANGE_MULTI 2 @@ -85,7 +92,7 @@ int nDevMask=0; int nSensorPresent; -volatile int sts_tof_distance_data[MAX_TOF_COUNT]={0x0}; +volatile int sts_tof_distance_data[MAX_TOF_COUNT]={0x0,0x0}; extern volatile uint8_t sensor_data_ready; VL53L0X_Dev_t VL53L0XDevs[]={ @@ -372,6 +379,9 @@ void STS_TOF250_Range_Process(void) void STS_TOF_VL53L0X_Range_Process(void) { int status=0, i; + /* HIGH_ACCURACY for STS_R1/R2/R3 short distance less than 1000mm */ + /* LONG_RANGE for STS_R5 long distance less than 2500mm */ + RangingConfig_e RangingConfig = HIGH_ACCURACY; //HIGH_ACCURACY; //LONG_RANGE; XWL55_WLE5_53L0X_Init(); if ((nDevMask ==0) || (nSensorPresent ==0)) @@ -418,12 +428,12 @@ void STS_TOF_VL53L0X_Range_Process(void) // ########## 1) return status ==0, // ########## 2) and ranging status for valid ranging value !!!!!!!!!!!!!!!!! } - HAL_Delay(30); + HAL_Delay(1); } while ((RangingMeasurementData.RangeStatus != 0)&&(rep <10)); sts_tof_distance_data[i] = (RangingMeasurementData.RangeStatus!=0)?STS_MAX_L0_RANGE:VL53L0XDevs[i].LeakyRange; } - HAL_Delay(30); + HAL_Delay(1); } // for i < MAX_TOF_COUNT if (sensor_data_ready != 0) {