STM32WLE5系列之2-stm32wle5ccu6移植pingpong通信

STMCU小助手 · 2022-10-20T10:31:01+00:00

简介 ; _1 N' S9 `4 z3 @( G% n# @% a官方只提供了STM32WL55JC和STM32WL55JC1的相关应用demo，由于封装不通我们并不能直接使用相关程序，需要移植才能使用。本次我们移植pingpong通信demo 4 Y3 t# i, d4 C/ g6 Z& n( j5 E& G" K2 C4 E$ D( y: J 一、工程移植 , r0 H! F( S" N( C! F' a/ Y4 m7 ?1、打开STM32CubeMX,选择start My projext from MCU开始工程 / E3 E- m0 ^$ M+ b * x9 i" e8 }4 R2 E0 x / u8 ]. D3 S" L; O4 q8 e , r6 [& l5 \/ s6 w; |. Q f2、在MCU/MPU处选择使用STM32WLE5CCU62 Q% w0 E- Q7 o* t3 x0 D' N / d/ T: A7 M$ D2 Z' R# X , U3 [& W+ N- W/ m% G' O: a6 ]% \5 w3 ~0 F T" \ 3、在File->import project导入pingpong例程，选择导入工程为C"\Users\用户\STM32Cube\Repository\STM32CuBE_FW_WLV1.2.0\Projects\NUCLEO-WL55JC\Applications\SubGHz_Phy\SubGHz_Phy_PingPong\SubGHz_Phy_PingPong.ioc * u4 k! ?5 h. o* U4 W" q3 R+ H用户为自己实际的用户名 * r1 l# ~& V+ R- Z u * y, A: {% s% \3 M* [ % [) a5 |% ^1 Q6 l' O. [ 2 @3 p% R' a# j6 c2 h导入后会有些报错，是因为原来WL55JC是BGA的封装引脚要多一些，而stm32wle5ccu6没有 9 H' m) U- U2 T7 W2 W0 E 1 B2 C9 {/ v6 b, d4、在Project Manager->Project中设置工程名和存放路径，Toolchain/IDE设置为MDK-ARM;Code Generator设置为Copy all used libraries into the project folder- O' O+ ?) b( ^( ?9 ` 2 g3 ~) R9 d, a& C# s; B$ h: a/ v% o # J! u8 H/ r/ U- @. R8 r. M1 I* o+ P+ {9 Z 7 w9 C6 @8 [! [- A . a% V" Z* R5 q& H5 S: L 5、时钟输入配置，HSE和LSE都配置为Crystal/Ceramic Resonator : _- t, l0 c- Q$ A# d! R2 @+ i8 P/ r3 J- Q ) m# j3 ?. s; v. H/ c 2 p" b/ ` |. g* [8 ^ e! ]% u( r; g( ^5 y6、RTC开启Alarm A并且使能中断 & |7 _0 g4 E8 W/ M E* A) C6 W) X. J; M1 ^8 v* b 8 B1 }: k' d* h) M9 c5 s/ [ ! X& f9 U5 k' f5 B " @, s+ _" E) Q0 T7、SubGHz_Phy设置如下 0 X2 g7 b7 b3 O( i' z( _3 _! O/ _9 A$ K1 t3 X & a' z/ v% r' S. ? C3 e ; Y/ s+ U7 {" b9 a 1 |5 s! N4 {$ f2 p$ i X! Z2 v+ ^. E, P8、时钟树配置，RTC使用LSE 4 F/ [6 W+ H5 |4 G9 W! S ; \' p( G0 z7 z5 E; B/ V# O 7 h( \+ D; N( k- s* w1 a ( g% s! D1 s0 ?2 j1 f* A5 j6 s 9、点击GENERATE CODE生成代码，打开keil工程然后编译会报以下错误，是由于我们没有添加BSP包3 Y. |. P" T" @4 Z) x |. t ; d* ^) r% E' n3 n 6 a! ^; ]: t$ s! r M) j- {. H* e 10、把下载的软件包C:\Users\用户\STM32Cube\Repository\STM32Cube_FW_WL_V1.2.0\Drivers中的BSP包拷贝到当前工程下。然后在keil中添加文件和其所在目录索引。 / {0 S9 _- \! p$ u* j* W11、然后编译工程，0 error 0 waring8 L1 ]. \" F0 F8 E # D9 i3 Y% |, L$ [/ F# F$ G( k 5 x( _2 n, K- M9 i ^8 T 4 R- K( z0 p7 e1 H, M: C二、应用移植 - x9 w; Y& W6 `1、修改BSP中关于射频开关部分的引脚定义，我们使用的亿佰特的E77模块，所以射频开关为PA6和PA7 " d" C3 Z3 ?0 q `) b& Ostm32wlxx_nucleo_radio.h修改为下面这样，我们只使用了RF_SW_CTRL3_PIN、RF_SW_CTRL1_PIN 两个脚，另一个不用管。 ; \- v% ?& y3 a% k- y' Y+ e- E) G! ^9 A$ h, [# n; M/ u #define RF_SW_CTRL3_PIN GPIO_PIN_6 4 |" W) F5 r" B2 D& v #define RF_SW_CTRL3_GPIO_PORT GPIOA % v& U% `. K" V& X- F8 J #define RF_SW_CTRL3_GPIO_CLK_ENABLE() __HAL_RCC_GPIOC_CLK_ENABLE() ! _6 A0 }4 }3 p #define RF_SW_CTRL3_GPIO_CLK_DISABLE() __HAL_RCC_GPIOC_CLK_DISABLE() 1 m5 k: H6 t" A0 E$ u$ D 3 Z/ N' |2 }! g0 Y0 H8 H #define RF_SW_CTRL1_PIN GPIO_PIN_7 2 U8 E. w) A8 N2 E1 }: B7 o; t7 ? #define RF_SW_CTRL1_GPIO_PORT GPIOA # \3 G4 ~ [1 B/ t5 @7 k/ }5 u #define RF_SW_CTRL1_GPIO_CLK_ENABLE() __HAL_RCC_GPIOC_CLK_ENABLE() 7 {- |! F `" N) j# N #define RF_SW_RX_GPIO_CLK_DISABLE() __HAL_RCC_GPIOC_CLK_DISABLE() 复制代码 - W+ P9 |: h. K( y. T' G. n+ y由于射频开关不同，射频控制逻辑也需要修改，把stm32wlxx_nucleo_radio.c中射频开关修改如下所示5 f* U" R3 [% Y4 k0 P; z 6 m1 ~) e" |( L* j+ |6 k: k2 k ~. N int32_t BSP_RADIO_ConfigRFSwitch(BSP_RADIO_Switch_TypeDef Config) - E( `: D: ~' {. F" J' E% E { W5 b& |, }* b# j8 ` switch (Config) 1 y- x9 V7 r* B7 F( X9 O { ; K* E0 i, N+ |% ? case RADIO_SWITCH_OFF: - v' B# q K3 v { & y* d- j h+ t2 x- j /* Turn off switch */ 1 J H% o2 o2 \: t$ } HAL_GPIO_WritePin(RF_SW_CTRL3_GPIO_PORT, RF_SW_CTRL3_PIN, GPIO_PIN_RESET); 0 ~# ^* A% I$ Q' ?) s+ Z HAL_GPIO_WritePin(RF_SW_CTRL1_GPIO_PORT, RF_SW_CTRL1_PIN, GPIO_PIN_RESET); 9 u( L% r5 ]) |9 w+ { HAL_GPIO_WritePin(RF_SW_CTRL2_GPIO_PORT, RF_SW_CTRL2_PIN, GPIO_PIN_RESET); ! P+ i/ N7 o+ \4 a) T& _8 Q break; # s4 C1 h$ p5 `1 k } : K. R- n* [5 u+ p5 D case RADIO_SWITCH_RX: ! u8 y: P' d; r) G: n4 `7 L { ! V: V0 c6 n7 \ J* m' }# e; I /*Turns On in Rx Mode the RF Switch */ + j0 G; f; g- m4 N# T, _$ [ HAL_GPIO_WritePin(RF_SW_CTRL3_GPIO_PORT, RF_SW_CTRL3_PIN, GPIO_PIN_RESET); 6 I1 B# I. r4 }8 I% g" n8 k( ? HAL_GPIO_WritePin(RF_SW_CTRL1_GPIO_PORT, RF_SW_CTRL1_PIN, GPIO_PIN_SET); ) N2 {7 w3 w* S HAL_GPIO_WritePin(RF_SW_CTRL2_GPIO_PORT, RF_SW_CTRL2_PIN, GPIO_PIN_RESET); 3 E" T1 y7 b8 `& i1 f break; & [* C# i7 ]+ O: q1 }/ r# M% { } 6 ] @0 n1 o1 D9 S: J* q9 W* \- w case RADIO_SWITCH_RFO_LP: - O3 d3 u2 [) o( u4 D, @9 C8 i { , E7 L' w0 B* [. r: T /*Turns On in Tx Low Power the RF Switch */ 0 Z# a7 m3 Y. d3 u b! t HAL_GPIO_WritePin(RF_SW_CTRL3_GPIO_PORT, RF_SW_CTRL3_PIN, GPIO_PIN_SET); " `1 i) P5 a2 D HAL_GPIO_WritePin(RF_SW_CTRL1_GPIO_PORT, RF_SW_CTRL1_PIN, GPIO_PIN_RESET); 0 k) d' q& [0 s% I- D HAL_GPIO_WritePin(RF_SW_CTRL2_GPIO_PORT, RF_SW_CTRL2_PIN, GPIO_PIN_SET); 8 z2 y6 Q' o* v break; # T( @! |. h7 g& C } 5 A( ~) l" \3 V3 K/ A9 D case RADIO_SWITCH_RFO_HP: : i: ^) P. K. i2 { F4 k: N { : f4 c l6 g9 |1 z /*Turns On in Tx High Power the RF Switch */ : G! K& U! x( E" w4 E, ?, p' r HAL_GPIO_WritePin(RF_SW_CTRL3_GPIO_PORT, RF_SW_CTRL3_PIN, GPIO_PIN_SET); ; |2 p5 g1 z/ e% N9 O HAL_GPIO_WritePin(RF_SW_CTRL1_GPIO_PORT, RF_SW_CTRL1_PIN, GPIO_PIN_RESET); , a' H4 Z# I* L l" x HAL_GPIO_WritePin(RF_SW_CTRL2_GPIO_PORT, RF_SW_CTRL2_PIN, GPIO_PIN_SET); # h: D: c5 v; [( h/ }' x; y0 }, c break; 1 q0 n! b7 [8 K3 y* V+ c' l& F; _: O# ~ } 4 a! h S/ `0 t( E6 O' U6 P default: " X( C' i# l& P: t. ~& o break; 9 P& l E/ T: k0 M2 G( N C } 0 Q O; e' m: l4 L: o5 S , M. g5 d9 W* h return BSP_ERROR_NONE; 6 \3 L M2 Q3 B# h! T/ a4 i5 ` } 5 z8 B0 C6 w, N. ^; Q/ g" F4 s5 r" U' i( J! W# v; _' y" G int32_t BSP_RADIO_GetTxConfig(void) . T6 ~$ @. G# t0 B1 n! O4 x; O { O% A. F3 f& D8 A. h# A. R- A //return RADIO_CONF_RFO_LP_HP; 9 E5 F3 q. |( J, Z: U* r3 y8 P9 Q return RADIO_CONF_RFO_HP; 0 S( l) d) P1 |0 L4 M# n } ; F3 p& ^7 T/ s$ n) V' n* q9 [ ; q( W7 r0 d9 A) q // + t4 y c$ ?% ~: c% ~ //使用无源晶振 N# ?) ^$ B/ B: x" h+ O+ g* F9 _1 O /** , f& m% S: B) X Q0 a * @brief Get If TCXO is to be present on board ' r# _" A; k& l( s) _& Z$ c * @note never remove called by MW, # N& D* V7 E3 c$ U, F * @retval $ G9 f$ r* R/ [/ N * RADIO_CONF_TCXO_NOT_SUPPORTED 2 |4 \8 a6 P1 c7 m# F9 ^) g5 a * RADIO_CONF_TCXO_SUPPORTED " [0 i, h L: a( ~6 e1 R+ e */ 3 t/ }* `* r0 }* Y; W$ u5 R! w3 Y int32_t BSP_RADIO_IsTCXO(void) 4 v! N! T8 H7 U: I" ?- ?2 u; d { 4 x0 D, f0 w& w# D //return RADIO_CONF_TCXO_SUPPORTED; 3 I, a% r# G0 T& r/ ^/ I( w return RADIO_CONF_TCXO_NOT_SUPPORTED ; t2 U& p+ S8 I" z9 H K } # k6 ?: |9 \7 O3 O9 b 由于亿佰特的E77模块使用的是无源晶振，所以需要调整晶振负载电容以保证晶振精度 % A, v. @- @0 }) g3 m: o2 T7 h （这里不调整也可，因为是两个模块互通，但考虑后面lorawan工程还是调整为好）,采用 & s6 M" J ?8 W Q 模块厂商推荐值0x0B ) R5 ]) E3 [! z. e //#define XTAL_DEFAULT_CAP_VALUE ( 0x20UL ) 9 {! \4 Z; `4 q #define XTAL_DEFAULT_CAP_VALUE ( 0x0BUL ) 复制代码 y2 k0 a& W X2 Y6 i/ f8 k, O: u 2、修改subghz_phy_app.c文件，CubeMx刚生成工程是没有应用程序的。我们只需要从STM32Cube_FW_WL_V1.2.0软件包中去找到对应的工程文件然后修改，修改后的subghz_phy_appp.c如下。 : O. U) Y7 \& I8 E$ W 7 B" [3 K( `$ A8 m+ Z) G /* USER CODE BEGIN Header */ ; u* n) M2 J# i" s4 @( [* o! y /** + r& x+ |6 h1 M, X2 e ****************************************************************************** : l$ w* K8 [2 v- m- H * @file subghz_phy_app.c ( h! ~0 c2 x: Q3 V1 J * @author MCD Application Team % r8 }# @1 q9 u' U+ F * @brief Application of the SubGHz_Phy Middleware % I0 D1 \* w& p: H6 K- ]; T* e ****************************************************************************** 9 r+ A: t) `! p+ Y7 g * @attention - S% E9 }# R- l * - n9 ]1 X1 h" \. y2 x * Copyright (c) 2022 STMicroelectronics. 6 }! ~: k5 ?0 r+ d * All rights reserved. / N8 @. d6 _* I: X/ G5 I * * n" ^& T- `' O: K( g * This software is licensed under terms that can be found in the LICENSE file & I4 j5 E# R) H- K+ t L C * in the root directory of this software component. ) ?0 U: c2 [% I R! q4 N& E8 _ * If no LICENSE file comes with this software, it is provided AS-IS. 3 k" L" R, [% @1 d6 a * 1 |2 Y) E" L1 ^" d0 L' u2 r7 k ****************************************************************************** ; I7 v1 P9 } R! A' T; c% w w */ 6 v+ m- u0 ]- S6 o! ~" w! @, e /* USER CODE END Header */ 5 ^2 |- i/ j* z1 f4 V ( j) o$ m) V! ]+ a. k4 T' k /* Includes ------------------------------------------------------------------*/ ) }2 g0 C9 N: F #include "platform.h" * n3 C# p z6 Q# Z1 z #include "sys_app.h" 7 [, [. k% E* ` @9 H #include "subghz_phy_app.h" . t( m2 @6 c$ L/ y2 Y0 p& ` #include "radio.h" & E q+ o3 X% ` g 6 c' G9 M5 [" r! V /* USER CODE BEGIN Includes */ 3 c8 y* c' O1 j4 o+ t* O V# { #include "stm32_timer.h" * G1 @: l$ e/ Z" ~3 H- k a: J #include "stm32_seq.h" . }: k# j1 ]) q) m1 e" `/ L #include "utilities_def.h" 9 z; ]- [ B) Z' ]1 I #include "app_version.h" . u: w5 ~( @1 U B, M" P #include "subghz_phy_version.h" & V6 ^' o' l8 H$ D& v4 w$ }4 A /* USER CODE END Includes */ $ ~' {! {9 ] ] / @- d% z- S) q+ O5 }8 l /* External variables ---------------------------------------------------------*/ * i/ ?- h6 `- N/ Y, O3 H6 | /* USER CODE BEGIN EV */ - b& y) W3 w: ? $ p' h' @* `( @+ i" ?5 h2 ]9 ^( K2 l /* USER CODE END EV */ 8 E, t+ |3 @7 j) u9 P' v4 j0 I1 P1 ^& z& ]2 e+ i, I* w /* Private typedef -----------------------------------------------------------*/ & O/ Y, p3 `2 V, n/ W# l' E# Z $ v4 r) y( u' ?8 ?5 P- Y, i* V, J /* USER CODE BEGIN PTD */ ( q3 z1 I, F S0 `% C: } typedef enum : c+ J' F) j8 }. j' i# N { 3 a& W& q7 Q8 w/ P5 Z1 }: l) O RX, ' p& Z2 U% a0 | RX_TIMEOUT, . f0 a$ E2 q9 ] } RX_ERROR, P" c5 f$ q( d! l; t TX, 8 [: T' R/ D8 C! i/ w2 D; C! r TX_TIMEOUT, " [" i) l2 l) U. n( J } States_t; C/ U% w4 n( ~- S' X9 c /* USER CODE END PTD */ # G% {* a+ F$ l1 H2 C* l . y: A! S7 i3 p v /* Private define ------------------------------------------------------------*/ ( h' L% K- p% x6 ]' X/ t /* USER CODE BEGIN PD */ 8 l# }" }2 z m5 w. Z1 X /* Configurations */ , C5 a- L+ V3 U" w$ Q7 @4 l /*Timeout*/ ) R# E5 D7 P5 ^9 \ #define RX_TIMEOUT_VALUE 3000 " a: r8 N- ~5 |7 v+ q- f$ | #define TX_TIMEOUT_VALUE 3000 - t6 M1 j+ [: t: E y /* PING string*/ ! b1 v G, Y9 l' M #define PING "PING" , X7 U H/ ^8 ^ /* PONG string*/ 0 S6 p$ r& ^0 V. { #define PONG "PONG" 7 d9 Z' J6 ]+ J4 f9 H /*Size of the payload to be sent*/ ) v! e5 x$ c; v/ z /* Size must be greater of equal the PING and PONG*/ ; ^1 w( }2 n: I6 ^, G #define MAX_APP_BUFFER_SIZE 255 1 |* z" x( V# J4 m& ^: F9 ~1 ` #if (PAYLOAD_LEN > MAX_APP_BUFFER_SIZE) 2 i; {/ |5 T: a- w5 |) _- T #error PAYLOAD_LEN must be less or equal than MAX_APP_BUFFER_SIZE 8 G/ O/ f1 `' l #endif /* (PAYLOAD_LEN > MAX_APP_BUFFER_SIZE) */ ; y# C$ A8 _7 X: { /* wait for remote to be in Rx, before sending a Tx frame*/ . m0 P, \8 e. ?# I8 ?8 `! q: P #define RX_TIME_MARGIN 200 ) V% B% r! L( b, ~$ h /* Afc bandwidth in Hz */ , Q0 Z% S( f7 q( ]" A #define FSK_AFC_BANDWIDTH 83333 & O1 H/ z X8 D9 g% P5 ] /* LED blink Period*/ * Z1 Y+ p- Z1 R7 e2 {: v V( _2 J #define LED_PERIOD_MS 200 6 z; M5 a7 r/ M( x" @2 r0 ]2 T3 f /* USER CODE END PD */ $ ?! Z: d; ?( A, r/ r( O* }; \$ j j3 u% d /* Private macro -------------------------------------------------------------*/ $ B# H# c4 O2 a* `2 H6 ^ /* USER CODE BEGIN PM */ ! j( s' R5 c1 c# H% X# K; [8 j ) Z, ?6 _/ W- O. {, K /* USER CODE END PM */ : {0 q8 D- m# [, n4 c* w 3 X6 ]; I/ g, i- N6 W, S0 c9 I /* Private variables ---------------------------------------------------------*/ . e. @ i) Q, h4 s' J, o. V# Y /* Radio events function pointer */ 0 f% l# T& v! _7 [- C static RadioEvents_t RadioEvents; , a% t" X+ E% g2 o6 R2 ~ /* USER CODE BEGIN PV */ 8 K; n, x8 q5 R4 F /*Ping Pong FSM states */ 6 C1 `! Y0 X! W2 j8 k5 X! k static States_t State = RX; 0 Q/ q8 T9 h, v" j /* App Rx Buffer*/ * J+ u- U( \7 Z/ ?% E. v static uint8_t BufferRx[MAX_APP_BUFFER_SIZE]; 4 T- X6 ?2 l/ d+ S# l; q /* App Tx Buffer*/ 6 h8 a5 u- i5 l% X' w- P4 W# B8 o1 _ static uint8_t BufferTx[MAX_APP_BUFFER_SIZE]; 0 s; G3 V& S! b( t, @0 J /* Last Received Buffer Size*/ 6 H9 ]1 v/ @" Q$ l8 \( [! T uint16_t RxBufferSize = 0; - Z. `7 p t3 w6 f1 f- n: l0 @/ m j /* Last Received packer Rssi*/ : S8 j# T) ^8 A; j int8_t RssiValue = 0; 6 m% }$ l3 R: K, o" ~8 h /* Last Received packer SNR (in Lora modulation)*/ 3 k8 L, U7 {- S int8_t SnrValue = 0; + I+ G: K$ T) { | /* Led Timers objects*/ & n' a" C3 E+ D/ K% S- r) h static UTIL_TIMER_Object_t timerLed; " M1 R- Y1 M* Z8 s) ]9 U /* device state. Master: true, Slave: false*/ 3 Q' {' y9 h7 ^0 ] bool isMaster = true; ' J- z) q! O3 u6 T6 \1 T /* random delay to make sure 2 devices will sync*/ c8 Z# d S% J" n4 Q5 a /* the closest the random delays are, the longer it will 8 M0 P- I$ v% m$ | take for the devices to sync when started simultaneously*/ & A2 ?1 z: y3 T5 m, U static int32_t random_delay; 1 o4 x( Q' _$ @1 x2 E/ n( H /* USER CODE END PV */ * m" @& {/ |1 Q+ I" r6 `9 f: {/ D; y# h, w; b /* Private function prototypes -----------------------------------------------*/ - l" B+ B% K$ K$ ~4 v /*! 6 @4 x. Q+ r l# C' B6 p * @brief Function to be executed on Radio Tx Done event 6 X7 N! |- V) p( C# V, }/ T! D1 O */ , M' g. O, E1 q. H static void OnTxDone(void); 9 e/ e8 h6 O, z6 Y/ i# d% H3 b. N/ H /** & q: S& n* R/ d, g0 J * @brief Function to be executed on Radio Rx Done event + f8 [: o) M5 g0 @- F4 E * @param payload ptr of buffer received $ b8 P! g( q, ?' e/ p* | * @param size buffer size ; l0 I; i: x% ^' n, R * @param rssi i8 w1 E* @6 c1 Q M2 b * @param LoraSnr_FskCfo 5 Z. w0 P: V& Y2 n @1 j */ ) ]: n( v8 i: u2 _ Z$ S8 l static void OnRxDone(uint8_t *payload, uint16_t size, int16_t rssi, int8_t LoraSnr_FskCfo); : b2 c+ Z% X' \: M. p2 f! v v2 j/ k 8 d' E$ C* i, \- A /** , l/ N4 o) D0 t& ] * @brief Function executed on Radio Tx Timeout event * D% H) w/ L- N9 H4 z. A */ * w# v2 g8 I1 _* Q: V static void OnTxTimeout(void); e1 G$ ]3 x9 H. W c8 C# `& [# B: Y: ^- J5 l( k4 J /** 1 `( W% S+ s, G1 N5 ` n% k) o% B * @brief Function executed on Radio Rx Timeout event - I1 j! E4 q8 x& p$ W/ ?) i6 K */ " k$ Q# G$ q/ w static void OnRxTimeout(void); 5 T4 `- S: Z+ P; f% Y! x. s- G' B* r7 T) B) b# R1 W' C1 C2 C /** $ p! V' O. \5 F0 x4 y * @brief Function executed on Radio Rx Error event ; B/ H$ w7 W1 {, k4 F+ |$ |8 } */ ! w6 X- z5 [2 j' q% k static void OnRxError(void); % q, v2 Y, n: Y4 G* l1 a( A! J$ y # [) S* A) X. { Q+ S+ o /* USER CODE BEGIN PFP */ ! o5 H; h: Y7 R" J' t7 K2 ? /** 8 d. P# }1 N) l9 C" O& e1 v+ g/ v- k * @brief Function executed on when led timer elapses 7 I2 D' S( R; X * @param context ptr of LED context " Z7 _% W6 ~5 G/ |7 L# g3 a */ : q+ _( X+ b7 | static void OnledEvent(void *context); ; O \. y8 }1 g 8 x3 r: O" h' l+ ]$ j /** " o G+ Q% n2 P * @brief PingPong state machine implementation $ {( K% ~- A+ `& `0 c H, C) _; n */ I1 k6 L) u" Z static void PingPong_Process(void); % b9 w2 _5 ^8 ? /* USER CODE END PFP */ + x2 @ l ^( l1 V( E3 X # h4 J: F2 ] V1 h! N" C# Q% J /* Exported functions ---------------------------------------------------------*/ " ^0 p2 ?% m1 N0 Z. e void SubghzApp_Init(void) 5 q1 f. \% U6 m: \ J { ' H: C, P4 c* q' C' x7 V /* USER CODE BEGIN SubghzApp_Init_1 */ 4 P3 g& j4 V. F5 s$ H, }6 x5 g* f APP_LOG(TS_OFF, VLEVEL_M, "\n\rPING PONG\n\r"); " J: y3 ?' Q T7 m" n, g2 O6 O /* Get SubGHY_Phy APP version*/ $ S' U/ G8 I, A" \ APP_LOG(TS_OFF, VLEVEL_M, "APPLICATION_VERSION: V%X.%X.%X\r\n", 4 v. g# i# U& S, _( |+ e (uint8_t)(APP_VERSION_MAIN), 9 c! @7 q9 T- U: T$ @, ?5 \" Q (uint8_t)(APP_VERSION_SUB1), 4 J( i4 W" \ b% f0 H+ d (uint8_t)(APP_VERSION_SUB2)); - b& a6 \" U( |% t+ i' u) W3 L% ~, K ) m z% x0 G3 `9 T /* Get MW SubGhz_Phy info */ : W) G# `) E- d7 r1 w# [ APP_LOG(TS_OFF, VLEVEL_M, "MW_RADIO_VERSION: V%X.%X.%X\r\n", ; s9 o. U; H- @: j# e# p) z (uint8_t)(SUBGHZ_PHY_VERSION_MAIN), 6 S [) b$ a5 \% X( _ (uint8_t)(SUBGHZ_PHY_VERSION_SUB1), - B; `- ]6 `* I4 t- _! T (uint8_t)(SUBGHZ_PHY_VERSION_SUB2)); ) Y) F9 Y. _ W5 l3 R% O+ ^% V+ ~6 Y+ K /* Led Timers*/ 0 Y) g. s7 \$ o/ Z3 Y. s UTIL_TIMER_Create(&timerLed, LED_PERIOD_MS, UTIL_TIMER_ONESHOT, OnledEvent, NULL); ( y: }. x1 f) c0 E& ~: O7 n UTIL_TIMER_Start(&timerLed); ; M7 R6 {* E$ h: w# R /* USER CODE END SubghzApp_Init_1 */ + n) ?* F a% s( t, x2 r: V - @8 ~3 ^3 M! H+ J [9 R /* Radio initialization */ : q" f( L) a, B2 w& E9 l% g RadioEvents.TxDone = OnTxDone; ; P1 m, o. {7 X7 P- R$ m+ E RadioEvents.RxDone = OnRxDone; & b% Z7 z/ a# ^: U$ q' q S RadioEvents.TxTimeout = OnTxTimeout; $ q- m1 T/ ^$ Y' D RadioEvents.RxTimeout = OnRxTimeout; - d! P) e" m* ^5 M& e; h RadioEvents.RxError = OnRxError; , A6 y3 s. V; K0 M4 I; E0 W. V# f* Y3 g4 ~ Radio.Init(&RadioEvents); , a2 M1 X, z% P: A2 H. u 0 R ]/ n+ z ? /* USER CODE BEGIN SubghzApp_Init_2 */ + l7 V3 U' C0 m, { /*calculate random delay for synchronization*/ 6 y b( k$ ?! K. o0 q' J# m random_delay = (Radio.Random()) >> 22; /*10bits random e.g. from 0 to 1023 ms*/ * g" |0 z" E, Q. @6 L. v3 _. { 4 u+ d, O5 n1 | `* W8 ~8 G /* Radio Set frequency */ * s7 T a( ^6 V. `1 N" x/ w- Q E Radio.SetChannel(RF_FREQUENCY); . a6 p# U2 S1 P' u& Z . c5 s* C7 _0 N3 w% `5 s /* Radio configuration */ $ T( h. I j4 x2 G #if ((USE_MODEM_LORA == 1) && (USE_MODEM_FSK == 0)) ' ?, S: S6 }3 m2 V: M3 a3 m APP_LOG(TS_OFF, VLEVEL_M, "---------------\n\r"); 0 g( h8 y" ^; m5 a- C9 b APP_LOG(TS_OFF, VLEVEL_M, "LORA_MODULATION\n\r"); 6 @" \/ s9 |2 Z7 ^ APP_LOG(TS_OFF, VLEVEL_M, "LORA_BW=%d kHz\n\r", (1 , ~9 |8 s- |% q0 {8 Z APP_LOG(TS_OFF, VLEVEL_M, "LORA_SF=%d\n\r", LORA_SPREADING_FACTOR); : ^& T0 x; y3 Q! d% X n $ }6 T A% |0 _( ^ Radio.SetTxConfig(MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH, - H8 d' o" f2 I) k LORA_SPREADING_FACTOR, LORA_CODINGRATE, , ]% k2 \5 Q1 j- \9 G& M LORA_PREAMBLE_LENGTH, LORA_FIX_LENGTH_PAYLOAD_ON, 1 D$ Y" r: e7 E; y$ @% u" a% X true, 0, 0, LORA_IQ_INVERSION_ON, TX_TIMEOUT_VALUE); u0 U$ Y- T$ c8 M+ o+ L, I/ f2 F3 T% g; V4 X3 [; B Radio.SetRxConfig(MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR, + J0 s3 V6 u+ j9 L7 T5 X `9 [ LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH, % F: M: P" q3 B2 \ e/ T LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, 3 x) t3 K8 B' n8 F- x 0, true, 0, 0, LORA_IQ_INVERSION_ON, true); , V' [" e8 ]+ N5 ]0 S . z; ?5 X0 Y, g! D Radio.SetMaxPayloadLength(MODEM_LORA, MAX_APP_BUFFER_SIZE); $ t4 T7 a7 d# M% v0 a# ` 7 K9 R! ?5 @+ z. n9 C1 T; p% A #elif ((USE_MODEM_LORA == 0) && (USE_MODEM_FSK == 1)) ( m$ N, ` R! F9 B2 _- m0 [( E9 f APP_LOG(TS_OFF, VLEVEL_M, "---------------\n\r"); 8 }3 `1 r: M: W% Z/ }3 O7 K* L APP_LOG(TS_OFF, VLEVEL_M, "FSK_MODULATION\n\r"); N8 ~4 W- R, A7 [ APP_LOG(TS_OFF, VLEVEL_M, "FSK_BW=%d Hz\n\r", FSK_BANDWIDTH); " v9 I! j! ?4 z- O APP_LOG(TS_OFF, VLEVEL_M, "FSK_DR=%d bits/s\n\r", FSK_DATARATE); . \) Z4 s F6 ]4 _3 e5 Z! h' W1 v: V4 X4 K0 {$ h Radio.SetTxConfig(MODEM_FSK, TX_OUTPUT_POWER, FSK_FDEV, 0, 2 Y. J/ y9 E5 V$ i FSK_DATARATE, 0, 1 z( _" E F# e$ ~% i# t FSK_PREAMBLE_LENGTH, FSK_FIX_LENGTH_PAYLOAD_ON, : S5 J, ^) L1 h3 H true, 0, 0, 0, TX_TIMEOUT_VALUE); ; s8 D. H J4 `$ k p + Z0 x* X, B, i) K3 s8 [4 q, p- U Radio.SetRxConfig(MODEM_FSK, FSK_BANDWIDTH, FSK_DATARATE, ! i% Q: X/ b+ W. P4 b; l 0, FSK_AFC_BANDWIDTH, FSK_PREAMBLE_LENGTH, " o& W9 r& y* E: x1 F: T. _$ \ 0, FSK_FIX_LENGTH_PAYLOAD_ON, 0, true, * h( Y. Z; j: i9 Y& p 0, 0, false, true); P8 Z+ m( x6 U 8 F7 c" A" k! F1 |8 r4 R' C! E Radio.SetMaxPayloadLength(MODEM_FSK, MAX_APP_BUFFER_SIZE); 3 ?. P z: l: z* | Q " C7 Y# j h, @) q+ _ #else 2 R$ K4 [. ?3 u$ S #error "Please define a modulation in the subghz_phy_app.h file." 2 Z( o" W: h! N9 S$ x( y #endif /* USE_MODEM_LORA | USE_MODEM_FSK */ # }& O o; r2 J. M1 F3 R& t2 M+ h! A/ t /*fills tx buffer*/ - N3 y3 A0 F5 g; D# h3 T+ D9 c memset(BufferTx, 0x0, MAX_APP_BUFFER_SIZE); ! b7 D/ f+ ~& A4 n1 \+ Z1 P4 N5 y, N' W ) y+ p- F2 X# g, s8 k0 K% ^ APP_LOG(TS_ON, VLEVEL_L, "rand=%d\n\r", random_delay); 7 Z P$ a- m; z /*starts reception*/ 7 f( M- D+ D) J$ S5 Q0 ]6 i Radio.Rx(RX_TIMEOUT_VALUE + random_delay); 8 H8 q+ |: k% l6 k: t; v : U: r8 \$ O, u/ s0 x- E0 D /*register task to to be run in while(1) after Radio IT*/ + U; R5 X, R( a3 [# W9 z# T UTIL_SEQ_RegTask((1 0 K" V2 A* g# B% A1 P, [ /* USER CODE END SubghzApp_Init_2 */ 0 q, l& Y9 {0 _5 e. X- N/ [ } ' P& I8 F P' r8 n % P0 S; l- p/ v4 P! @8 {" D/ { /* USER CODE BEGIN EF */ 2 {( |& f0 x2 t 8 i7 }) x& F4 t- t5 _5 A /* USER CODE END EF */ 6 M6 q6 O8 ? d7 @, s( C5 c 4 p! Y+ f6 i) i; f0 k1 E! F /* Private functions ---------------------------------------------------------*/ - k6 \+ r: z/ M8 c7 f! E+ l static void OnTxDone(void) ; F7 Q& N: {* e8 P+ b4 i { ) Z# ?* y8 y7 Q2 R# W /* USER CODE BEGIN OnTxDone */ - | v0 l; d6 q( `( y APP_LOG(TS_ON, VLEVEL_L, "OnTxDone\n\r"); % C% b% m! n: O/ y) Y /* Update the State of the FSM*/ 0 _1 u: a2 d: q- \8 L$ {! c5 ^ State = TX; % F% \: M/ L. P6 O! W0 j /* Run PingPong process in background*/ - j: o# e/ R P# B UTIL_SEQ_SetTask((1 3 `+ y- K; J2 x' v* t: W$ q /* USER CODE END OnTxDone */ 4 L* \& l+ c! |0 i- ~$ S; h } F' A# w* F% R& O O ( S# d7 K+ L- k" M: u/ o static void OnRxDone(uint8_t *payload, uint16_t size, int16_t rssi, int8_t LoraSnr_FskCfo) 7 P7 D3 e2 T" e6 ?6 _) ~; {9 v { 1 l6 g- }9 ] s0 f% I& E /* USER CODE BEGIN OnRxDone */ ! P5 h! R3 v! v! _: z, D" A APP_LOG(TS_ON, VLEVEL_L, "OnRxDone\n\r"); . m. F2 V! M/ K" J/ r' W& s. F7 E5 V #if ((USE_MODEM_LORA == 1) && (USE_MODEM_FSK == 0)) , N* n: e* b6 z$ H: }# M APP_LOG(TS_ON, VLEVEL_L, "RssiValue=%d dBm, SnrValue=%ddB\n\r", rssi, LoraSnr_FskCfo); & m( ^ [- i0 T1 N3 x9 a /* Record payload Signal to noise ratio in Lora*/ 3 J& i+ a+ P4 a3 y, M SnrValue = LoraSnr_FskCfo; 9 B }( |% l1 v0 M# k# e6 e* [ #endif /* USE_MODEM_LORA | USE_MODEM_FSK */ 0 D }1 ^ q2 ]7 B v #if ((USE_MODEM_LORA == 0) && (USE_MODEM_FSK == 1)) # D- s/ |* Z- j% C; T APP_LOG(TS_ON, VLEVEL_L, "RssiValue=%d dBm, Cfo=%dkHz\n\r", rssi, LoraSnr_FskCfo); " m6 B z. |2 n; j( n SnrValue = 0; /*not applicable in GFSK*/ ) D* c( d u# k# ^ #endif /* USE_MODEM_LORA | USE_MODEM_FSK */ ! C5 G1 k/ @8 V$ i) h /* Update the State of the FSM*/ 3 h9 D! G6 V% A2 {6 ]6 o State = RX; : [. X: C3 [# G* G& D /* Clear BufferRx*/ . S0 L2 q/ S* l memset(BufferRx, 0, MAX_APP_BUFFER_SIZE); % w1 `6 t0 {2 A# Z0 n( Z /* Record payload size*/ ! L' v- l: S( f& _5 y RxBufferSize = size; w6 @8 p5 l: I# A) n2 R- G if (RxBufferSize . x5 k6 w& i8 i7 V9 {+ H { 5 x4 \- }9 R( A2 I7 p memcpy(BufferRx, payload, RxBufferSize); 7 N6 O: n9 N( t/ D; c( v7 c } 9 J5 j. `* H8 {5 w /* Record Received Signal Strength*/ 1 i. `7 a+ t8 ^3 o% | RssiValue = rssi; 9 L; C6 @8 I4 M* i) j- n. C /* Record payload content*/ " s$ K3 b$ o h( G! U# X APP_LOG(TS_ON, VLEVEL_H, "payload. size=%d \n\r", size); 5 A- ]9 j! ~) O4 B& _* L for (int i = 0; i 5 O# m( c6 R! m2 h* o! w' `* b { : x7 f+ S1 _+ K+ | APP_LOG(TS_OFF, VLEVEL_H, "%02X", BufferRx); 4 K$ z u; W) K5 ] if (i % 16 == 15) 6 S( P8 E3 Z5 \# l { ~. m, K( P" x) [6 B8 o APP_LOG(TS_OFF, VLEVEL_H, "\n\r"); r7 [/ c/ G* C* } } ; _/ \ ]& x8 i) M- a# X } . z4 Q4 |- e5 T" R* |/ {$ G2 C APP_LOG(TS_OFF, VLEVEL_H, "\n\r"); % [6 |. k2 s9 g7 @) Z8 ? @; S /* Run PingPong process in background*/ 6 F1 k; j2 O8 z, [ UTIL_SEQ_SetTask((1 6 g5 |7 G0 V2 I. c /* USER CODE END OnRxDone */ ' s c# E! E5 t8 Z" ^/ w } 4 [/ b( u% i6 D3 v% P4 b+ L$ ~/ @6 X$ Q+ f1 J static void OnTxTimeout(void) 5 v- \; C, I! M9 j) D1 Y( H { 0 l4 O L2 n7 y' E! K/ u5 n0 O /* USER CODE BEGIN OnTxTimeout */ & u7 ^6 P. H3 z, @& u APP_LOG(TS_ON, VLEVEL_L, "OnTxTimeout\n\r"); # k5 u. A" S" j5 S" d% ? /* Update the State of the FSM*/ " d+ @. J, O, L3 N( D0 G" [ State = TX_TIMEOUT; 3 q6 N7 j! D, V7 Q6 E' F- a3 r- B* e /* Run PingPong process in background*/ 9 V4 r/ Y$ G: u% F% m UTIL_SEQ_SetTask((1 1 k3 w4 X5 r# B3 r/ Y& E /* USER CODE END OnTxTimeout */ : S& J) c6 T6 H5 O2 n/ a5 U } 8 E5 j$ w5 w( C3 `5 g3 Q2 l# R : o6 a8 S4 x/ ^ static void OnRxTimeout(void) 8 ^. ^% E' z7 K0 K9 e { $ |5 @: I H* X7 }7 b; O /* USER CODE BEGIN OnRxTimeout */ 7 L: Z4 b0 O% a+ u7 u6 H APP_LOG(TS_ON, VLEVEL_L, "OnRxTimeout\n\r"); 5 B3 l: `- r& \* Y7 } /* Update the State of the FSM*/ ( X2 d* ?' n( h State = RX_TIMEOUT; # M( b* Y; K/ ^5 Z: l& }0 i! F /* Run PingPong process in background*/ , a$ Q' A3 J$ Y$ E- f" x! O( p+ R UTIL_SEQ_SetTask((1 z4 u. d/ D G2 K1 { /* USER CODE END OnRxTimeout */ / ]- h, X* C! W, E1 I) H } ) {" z5 |) i! E7 M2 `" i: w& t/ |4 r% l3 J; R+ P static void OnRxError(void) / i d$ }- @' O2 s; t6 ^ { 4 W6 A# Q8 J: D9 p /* USER CODE BEGIN OnRxError */ 1 ^! m% ~/ u N+ @% P8 a2 I# O APP_LOG(TS_ON, VLEVEL_L, "OnRxError\n\r"); ( U0 d" z5 i) a5 c9 k /* Update the State of the FSM*/ 9 r* X7 W7 m- L- w State = RX_ERROR; 9 O7 ?+ x: S5 K: \6 k* S /* Run PingPong process in background*/ 5 `& c* K; Q" V; d6 b; o UTIL_SEQ_SetTask((1 5 z+ j* ] y5 T" q# J /* USER CODE END OnRxError */ ) G4 I% e2 `* \. o, R } 1 L" s# A" \# G& z2 V) E 6 P. ^3 g2 Y& b5 T- s; S4 l- O /* USER CODE BEGIN PrFD */ C! s0 R) U+ w4 k/ `) H static void PingPong_Process(void) ( e+ r5 i: z' ~5 `. W( o { 6 O: j6 ?2 R; X, ^ Radio.Sleep(); : @# C5 s# z" g+ m + ]- ?# z' b/ l" z! _ switch (State) 3 S' v+ R$ R. d4 o& j { 4 k- R' c( M0 C% n case RX: $ n" M# Z6 c& C" |7 }+ C. G* e! u7 ^' E( i$ | if (isMaster == true) # c9 {( T% }* R/ j { 5 ?! C* o0 \' i7 n, o; \4 r- T if (RxBufferSize > 0) . U: F5 P# g5 C. o$ e+ K { 0 s u) P M; G) s% e4 @! ? if (strncmp((const char *)BufferRx, PONG, sizeof(PONG) - 1) == 0) ' r2 x0 Y7 v# p# m0 w { $ m3 }4 Y; |% S0 [ UTIL_TIMER_Stop(&timerLed); 2 o2 R9 j& E5 v# E& _ /* switch off green led */ ; w0 X1 {+ o1 T& l3 [ Q HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET); /* LED_GREEN */ 1 [/ s7 o1 [, L C" A H /* master toggles red led */ / h" x9 Q% G0 Y4 B HAL_GPIO_TogglePin(LED3_GPIO_Port, LED3_Pin); /* LED_RED */ 7 E1 n2 t1 S) J: l- W /* Add delay between RX and TX */ 9 Y& _4 a6 \# D( G! u0 M& f2 v HAL_Delay(Radio.GetWakeupTime() + RX_TIME_MARGIN); , D4 _, Z9 M- O6 q' t8 F% h /* master sends PING*/ : i5 [. T/ l0 u& A* L% x1 c APP_LOG(TS_ON, VLEVEL_L, "..." 1 u6 p1 G$ Q- I) k& r5 m. _ "PING" . @( k5 x; ?+ Y3 D- h. {2 S& \1 ^ "\n\r"); % F4 W# H' E( z S: N; F0 D APP_LOG(TS_ON, VLEVEL_L, "Master Tx start\n\r"); 9 F4 [: _& \& u* L, l memcpy(BufferTx, PING, sizeof(PING) - 1); $ }; O) M2 \* \8 K: ^) \% W Radio.Send(BufferTx, PAYLOAD_LEN); ( V: s) g0 S% r% Z! R. d6 e3 z; m% G } 7 E( \8 G+ D4 X/ d else if (strncmp((const char *)BufferRx, PING, sizeof(PING) - 1) == 0) 9 b5 q- j, f0 `2 U4 w { 3 W! w( B; S5 ?2 V1 V* J& m8 F% |4 b /* A master already exists then become a slave */ 9 _2 R# a+ P% m0 @1 ~) k7 w& `. v$ | isMaster = false; ' u/ ^- { u" I APP_LOG(TS_ON, VLEVEL_L, "Slave Rx start\n\r"); : k, p' s$ k+ J5 x4 L4 y5 t Radio.Rx(RX_TIMEOUT_VALUE); + l2 K4 Y# J, v" T* B3 F+ J0 U- R } $ D4 y3 n( @0 ]" k+ Y else /* valid reception but neither a PING or a PONG message */ + [' C, I* _# w3 A+ X% V* ?6 _# K% @ { 7 D& Q1 ?/ k2 M# D /* Set device as master and start again */ / C N. I1 l. R( j' g4 Y# T5 b- { isMaster = true; 5 n' _' l4 K& p6 v; q APP_LOG(TS_ON, VLEVEL_L, "Master Rx start\n\r"); # ^4 }( [' i8 ~3 M; u1 Z1 J Radio.Rx(RX_TIMEOUT_VALUE); : R2 F( {% B. |2 h+ R' i } ! G& C% L; {4 ?( I1 V } % U8 D ^' c0 \# {( N' |* L } E% q1 K6 M. w; p8 f- Z# T' @ else 3 C+ T( O9 R' a { : h0 O. L; s5 G7 B6 X$ D if (RxBufferSize > 0) 1 Z! `& [9 @# R- x' D/ m { 0 `$ }1 f, @! e# D if (strncmp((const char *)BufferRx, PING, sizeof(PING) - 1) == 0) 7 G5 _5 B" U: r4 j3 A4 O/ \$ B. { { 7 k9 }. l2 @" \8 R1 U5 v C UTIL_TIMER_Stop(&timerLed); & Z; O, a2 X# U, B) } /* switch off red led */ ' V# i% f; U% a- F0 y HAL_GPIO_WritePin(LED3_GPIO_Port, LED3_Pin, GPIO_PIN_RESET); /* LED_RED */ . X( I" y9 O) ~6 c$ e' @ /* slave toggles green led */ ! n$ n$ R' |/ b" u- h& O HAL_GPIO_TogglePin(LED2_GPIO_Port, LED2_Pin); /* LED_GREEN */ ( t( o0 U/ n/ j; z( p9 u /* Add delay between RX and TX */ 1 i! ]" B" ^& o6 s" \8 T2 M HAL_Delay(Radio.GetWakeupTime() + RX_TIME_MARGIN); & q4 O. o, B* H- j /*slave sends PONG*/ 4 y; a. S; o8 j; P APP_LOG(TS_ON, VLEVEL_L, "..." 9 J% F* W9 D8 o8 W" q! o2 K "PONG" . a5 K2 q3 f0 ]% T) l h "\n\r"); 7 l; n9 m/ A) x' K# c! ^ APP_LOG(TS_ON, VLEVEL_L, "Slave Tx start\n\r"); - k) w! u! I. Z" ^( Q/ g memcpy(BufferTx, PONG, sizeof(PONG) - 1); 4 J' L) S3 d2 _) b( { Radio.Send(BufferTx, PAYLOAD_LEN); * Z( ^- |* ~- s0 } } - ^% \( T( I+ r* \ else /* valid reception but not a PING as expected */ 6 r- `) ]4 k7 X+ ^/ r1 ^' k { ( S+ k* V- s4 T2 ^ /* Set device as master and start again */ / V# c t" D) e& M' y isMaster = true; 7 P/ ~$ j, R& p9 N' a% V1 S: X APP_LOG(TS_ON, VLEVEL_L, "Master Rx start\n\r"); 9 J! _6 a9 P. W. K0 A: U Radio.Rx(RX_TIMEOUT_VALUE); , a3 K4 H3 _/ g1 o } - H$ A, [* j, {" g0 i/ j8 ] } 5 U, R+ j; ^0 W) t } 6 N8 V# r% b7 P& ? break; 1 Y. d* s) t" j: z' c case TX: 3 v% w7 v/ C" o! L; Z APP_LOG(TS_ON, VLEVEL_L, "Rx start\n\r"); 1 ^$ |/ c/ M9 {9 W# E X+ x3 f Radio.Rx(RX_TIMEOUT_VALUE); 1 ~5 n% i! V. v7 s# V$ O7 w. c. G break; " \* F3 R9 K7 e/ m1 J case RX_TIMEOUT: 5 `5 k0 f: W. d0 u case RX_ERROR: 0 y1 ~8 c! s; e9 n# }7 n9 _ if (isMaster == true) 5 C9 |6 C3 n# V8 h1 K) r { 7 L) o ]: ?% @' [5 H /* Send the next PING frame */ # f% K/ X; x# C; _& X) V- g" B /* Add delay between RX and TX*/ $ H" F0 y5 p5 v, A1 _! l /* add random_delay to force sync between boards after some trials*/ ! x% F4 H: X: A9 @5 I/ W: z HAL_Delay(Radio.GetWakeupTime() + RX_TIME_MARGIN + random_delay); ! j' f6 r" v: a7 B0 A$ ^ Q! F4 P& r L APP_LOG(TS_ON, VLEVEL_L, "Master Tx start\n\r"); , L& N) `: z6 z /* master sends PING*/ 1 R9 U* a ^( \8 R" v8 E memcpy(BufferTx, PING, sizeof(PING) - 1); , @/ s. l* u3 |% G$ e0 b Radio.Send(BufferTx, PAYLOAD_LEN); , F: ?# \/ W, H3 x' r } / h( ?. d6 S& ?9 ]) b/ L6 b5 x, n else + V8 B/ U- e1 q# m7 z, L { 9 n+ ]/ F( n* L" g2 B0 u' X" W: p APP_LOG(TS_ON, VLEVEL_L, "Slave Rx start\n\r"); 3 T* Y# x, C+ b; n B Radio.Rx(RX_TIMEOUT_VALUE); + x" j* v1 x3 g } 3 u2 r0 S3 c2 l2 ~1 M$ R+ b break; - E# U9 A1 u3 ^' u4 k; A2 H5 } case TX_TIMEOUT: & }+ g0 y, d* x0 R" X+ O APP_LOG(TS_ON, VLEVEL_L, "Slave Rx start\n\r"); % R# |- l0 M) K1 v7 L2 K$ B Radio.Rx(RX_TIMEOUT_VALUE); M( y" }' o4 c* c; P break; . w+ z* ~: |1 Z2 h( T3 L default: ; ]. w! o8 d* O! v S" d: ` break; / r- Y. B& T/ T0 {) t } . e, [% l0 a. @ } 7 O" R4 s7 k; l7 e + {/ \3 \% @% w! t, h$ x0 S static void OnledEvent(void *context) " h6 p& m' G% C7 X! j- }8 r { ( x& \2 J: t7 x4 a8 w, O HAL_GPIO_TogglePin(LED2_GPIO_Port, LED2_Pin); /* LED_GREEN */ $ E9 Q O, R5 C( x HAL_GPIO_TogglePin(LED3_GPIO_Port, LED3_Pin); /* LED_RED */ 9 _5 A/ H$ x7 ^( W: z) J# C UTIL_TIMER_Start(&timerLed); $ B8 A/ V D8 b k } % {& C' r' D& c; G$ W! @) `, [' a /* USER CODE END PrFD */ 复制代码2 D6 s2 {3 t! Z% B) p1 l) ?0 r 三、下载测试2 H1 |, w3 H* r. A3 A; q$ } 最后烧录下载后，正常pingpong通信/ x# }. q/ p3 ` `- u* Y5 M4 m- r + H0 G9 Z) ]4 |: `5 @" | X" p, I———————————————— & D2 T& q, X# T: t* x& o版权声明：北世安 g1 I6 ^' `% g" d- P : p M5 |9 c2 S u5 p& x ! I- {! C8 `6 r8 f* l7 _

[复制链接]

STMCU小助手发布时间：2022-10-20 18:31

技术帖
文章封面:
文章简介:	STM32WLE5系列之2-stm32wle5ccu6移植pingpong通信

简介
官方只提供了STM32WL55JC和STM32WL55JC1的相关应用demo，由于封装不通我们并不能直接使用相关程序，需要移植才能使用。本次我们移植pingpong通信demo

一、工程移植
1、打开STM32CubeMX,选择start My projext from MCU开始工程

2、在MCU/MPU处选择使用STM32WLE5CCU6

3、在File->import project导入pingpong例程，选择导入工程为C"\Users\用户\STM32Cube\Repository\STM32CuBE_FW_WLV1.2.0\Projects\NUCLEO-WL55JC\Applications\SubGHz_Phy\SubGHz_Phy_PingPong\SubGHz_Phy_PingPong.ioc
用户为自己实际的用户名

导入后会有些报错，是因为原来WL55JC是BGA的封装引脚要多一些，而stm32wle5ccu6没有

4、在Project Manager->Project中设置工程名和存放路径，Toolchain/IDE设置为MDK-ARM;Code Generator设置为Copy all used libraries into the project folder

5、时钟输入配置，HSE和LSE都配置为Crystal/Ceramic Resonator

6、RTC开启Alarm A并且使能中断

7、SubGHz_Phy设置如下

8、时钟树配置，RTC使用LSE

9、点击GENERATE CODE生成代码，打开keil工程然后编译会报以下错误，是由于我们没有添加BSP包

10、把下载的软件包C:\Users\用户\STM32Cube\Repository\STM32Cube_FW_WL_V1.2.0\Drivers中的BSP包拷贝到当前工程下。然后在keil中添加文件和其所在目录索引。
11、然后编译工程，0 error 0 waring

二、应用移植
1、修改BSP中关于射频开关部分的引脚定义，我们使用的亿佰特的E77模块，所以射频开关为PA6和PA7
stm32wlxx_nucleo_radio.h修改为下面这样，我们只使用了RF_SW_CTRL3_PIN、RF_SW_CTRL1_PIN 两个脚，另一个不用管。

#define RF_SW_CTRL3_PIN GPIO_PIN_64 |" W) F5 r" B2 D& v
#define RF_SW_CTRL3_GPIO_PORT GPIOA
% v& U% `. K" V& X- F8 J
#define RF_SW_CTRL3_GPIO_CLK_ENABLE() __HAL_RCC_GPIOC_CLK_ENABLE()! _6 A0 }4 }3 p
#define RF_SW_CTRL3_GPIO_CLK_DISABLE() __HAL_RCC_GPIOC_CLK_DISABLE()
1 m5 k: H6 t" A0 E$ u$ D
3 Z/ N' |2 }! g0 Y0 H8 H
#define RF_SW_CTRL1_PIN GPIO_PIN_72 U8 E. w) A8 N2 E1 }: B7 o; t7 ?
#define RF_SW_CTRL1_GPIO_PORT GPIOA# \3 G4 ~ [1 B/ t5 @7 k/ }5 u
#define RF_SW_CTRL1_GPIO_CLK_ENABLE() __HAL_RCC_GPIOC_CLK_ENABLE()
7 {- |! F `" N) j# N
#define RF_SW_RX_GPIO_CLK_DISABLE() __HAL_RCC_GPIOC_CLK_DISABLE()

复制代码

由于射频开关不同，射频控制逻辑也需要修改，把stm32wlxx_nucleo_radio.c中射频开关修改如下所示

int32_t BSP_RADIO_ConfigRFSwitch(BSP_RADIO_Switch_TypeDef Config)- E( `: D: ~' {. F" J' E% E
{
W5 b& |, }* b# j8 `
switch (Config)1 y- x9 V7 r* B7 F( X9 O
{; K* E0 i, N+ |% ?
case RADIO_SWITCH_OFF:
- v' B# q K3 v
{& y* d- j h+ t2 x- j
/* Turn off switch */
1 J H% o2 o2 \: t$ }
HAL_GPIO_WritePin(RF_SW_CTRL3_GPIO_PORT, RF_SW_CTRL3_PIN, GPIO_PIN_RESET);
0 ~# ^* A% I$ Q' ?) s+ Z
HAL_GPIO_WritePin(RF_SW_CTRL1_GPIO_PORT, RF_SW_CTRL1_PIN, GPIO_PIN_RESET);
9 u( L% r5 ]) |9 w+ {
HAL_GPIO_WritePin(RF_SW_CTRL2_GPIO_PORT, RF_SW_CTRL2_PIN, GPIO_PIN_RESET);
! P+ i/ N7 o+ \4 a) T& _8 Q
break; # s4 C1 h$ p5 `1 k
}: K. R- n* [5 u+ p5 D
case RADIO_SWITCH_RX:
! u8 y: P' d; r) G: n4 `7 L
{
! V: V0 c6 n7 \ J* m' }# e; I
/*Turns On in Rx Mode the RF Switch */+ j0 G; f; g- m4 N# T, _$ [
HAL_GPIO_WritePin(RF_SW_CTRL3_GPIO_PORT, RF_SW_CTRL3_PIN, GPIO_PIN_RESET);6 I1 B# I. r4 }8 I% g" n8 k( ?
HAL_GPIO_WritePin(RF_SW_CTRL1_GPIO_PORT, RF_SW_CTRL1_PIN, GPIO_PIN_SET); 
) N2 {7 w3 w* S
HAL_GPIO_WritePin(RF_SW_CTRL2_GPIO_PORT, RF_SW_CTRL2_PIN, GPIO_PIN_RESET); 3 E" T1 y7 b8 `& i1 f
break;& [* C# i7 ]+ O: q1 }/ r# M% {
}
6 ] @0 n1 o1 D9 S: J* q9 W* \- w
case RADIO_SWITCH_RFO_LP:
- O3 d3 u2 [) o( u4 D, @9 C8 i
{, E7 L' w0 B* [. r: T
/*Turns On in Tx Low Power the RF Switch */0 Z# a7 m3 Y. d3 u b! t
HAL_GPIO_WritePin(RF_SW_CTRL3_GPIO_PORT, RF_SW_CTRL3_PIN, GPIO_PIN_SET);
" `1 i) P5 a2 D
HAL_GPIO_WritePin(RF_SW_CTRL1_GPIO_PORT, RF_SW_CTRL1_PIN, GPIO_PIN_RESET); 0 k) d' q& [0 s% I- D
HAL_GPIO_WritePin(RF_SW_CTRL2_GPIO_PORT, RF_SW_CTRL2_PIN, GPIO_PIN_SET); 
8 z2 y6 Q' o* v
break;
# T( @! |. h7 g& C
}
5 A( ~) l" \3 V3 K/ A9 D
case RADIO_SWITCH_RFO_HP:: i: ^) P. K. i2 { F4 k: N
{: f4 c l6 g9 |1 z
/*Turns On in Tx High Power the RF Switch */: G! K& U! x( E" w4 E, ?, p' r
HAL_GPIO_WritePin(RF_SW_CTRL3_GPIO_PORT, RF_SW_CTRL3_PIN, GPIO_PIN_SET);; |2 p5 g1 z/ e% N9 O
HAL_GPIO_WritePin(RF_SW_CTRL1_GPIO_PORT, RF_SW_CTRL1_PIN, GPIO_PIN_RESET); , a' H4 Z# I* L l" x
HAL_GPIO_WritePin(RF_SW_CTRL2_GPIO_PORT, RF_SW_CTRL2_PIN, GPIO_PIN_SET); # h: D: c5 v; [( h/ }' x; y0 }, c
break;
1 q0 n! b7 [8 K3 y* V+ c' l& F; _: O# ~
}
4 a! h S/ `0 t( E6 O' U6 P
default:
" X( C' i# l& P: t. ~& o
break; 9 P& l E/ T: k0 M2 G( N C
} 
0 Q O; e' m: l4 L: o5 S
, M. g5 d9 W* h
return BSP_ERROR_NONE;6 \3 L M2 Q3 B# h! T/ a4 i5 `
}
5 z8 B0 C6 w, N. ^; Q/ g" F4 s
5 r" U' i( J! W# v; _' y" G
int32_t BSP_RADIO_GetTxConfig(void). T6 ~$ @. G# t0 B1 n! O4 x; O
{ O% A. F3 f& D8 A. h# A. R- A
//return RADIO_CONF_RFO_LP_HP;
9 E5 F3 q. |( J, Z: U* r3 y8 P9 Q
return RADIO_CONF_RFO_HP;0 S( l) d) P1 |0 L4 M# n
}
; F3 p& ^7 T/ s$ n) V' n* q9 [
; q( W7 r0 d9 A) q
//
+ t4 y c$ ?% ~: c% ~
//使用无源晶振
N# ?) ^$ B/ B: x" h+ O+ g* F9 _1 O
/**, f& m% S: B) X Q0 a
* @brief Get If TCXO is to be present on board
' r# _" A; k& l( s) _& Z$ c
* @note never remove called by MW,
# N& D* V7 E3 c$ U, F
* @retval$ G9 f$ r* R/ [/ N
* RADIO_CONF_TCXO_NOT_SUPPORTED2 |4 \8 a6 P1 c7 m# F9 ^) g5 a
* RADIO_CONF_TCXO_SUPPORTED" [0 i, h L: a( ~6 e1 R+ e
*/
3 t/ }* `* r0 }* Y; W$ u5 R! w3 Y
int32_t BSP_RADIO_IsTCXO(void)
4 v! N! T8 H7 U: I" ?- ?2 u; d
{
4 x0 D, f0 w& w# D
//return RADIO_CONF_TCXO_SUPPORTED;
3 I, a% r# G0 T& r/ ^/ I( w
return RADIO_CONF_TCXO_NOT_SUPPORTED
; t2 U& p+ S8 I" z9 H K
}# k6 ?: |9 \7 O3 O9 b
由于亿佰特的E77模块使用的是无源晶振，所以需要调整晶振负载电容以保证晶振精度% A, v. @- @0 }) g3 m: o2 T7 h
（这里不调整也可，因为是两个模块互通，但考虑后面lorawan工程还是调整为好）,采用& s6 M" J ?8 W Q
模块厂商推荐值0x0B) R5 ]) E3 [! z. e
//#define XTAL_DEFAULT_CAP_VALUE ( 0x20UL )9 {! \4 Z; `4 q
#define XTAL_DEFAULT_CAP_VALUE ( 0x0BUL )

复制代码

2、修改subghz_phy_app.c文件，CubeMx刚生成工程是没有应用程序的。我们只需要从STM32Cube_FW_WL_V1.2.0软件包中去找到对应的工程文件然后修改，修改后的subghz_phy_appp.c如下。

/* USER CODE BEGIN Header */; u* n) M2 J# i" s4 @( [* o! y
/**
+ r& x+ |6 h1 M, X2 e
******************************************************************************: l$ w* K8 [2 v- m- H
* @file subghz_phy_app.c( h! ~0 c2 x: Q3 V1 J
* @author MCD Application Team
% r8 }# @1 q9 u' U+ F
* @brief Application of the SubGHz_Phy Middleware% I0 D1 \* w& p: H6 K- ]; T* e
******************************************************************************9 r+ A: t) `! p+ Y7 g
* @attention- S% E9 }# R- l
*
- n9 ]1 X1 h" \. y2 x
* Copyright (c) 2022 STMicroelectronics.
6 }! ~: k5 ?0 r+ d
** n" ^& T- `' O: K( g
* This software is licensed under terms that can be found in the LICENSE file& I4 j5 E# R) H- K+ t L C
* in the root directory of this software component.
) ?0 U: c2 [% I R! q4 N& E8 _
* If no LICENSE file comes with this software, it is provided AS-IS.3 k" L" R, [% @1 d6 a
*1 |2 Y) E" L1 ^" d0 L' u2 r7 k
******************************************************************************; I7 v1 P9 } R! A' T; c% w w
*/
6 v+ m- u0 ]- S6 o! ~" w! @, e
/* USER CODE END Header */
5 ^2 |- i/ j* z1 f4 V
( j) o$ m) V! ]+ a. k4 T' k
/* Includes ------------------------------------------------------------------*/
) }2 g0 C9 N: F
#include "platform.h"* n3 C# p z6 Q# Z1 z
#include "sys_app.h"
7 [, [. k% E* ` @9 H
#include "subghz_phy_app.h"
. t( m2 @6 c$ L/ y2 Y0 p& `
#include "radio.h"& E q+ o3 X% ` g
6 c' G9 M5 [" r! V
/* USER CODE BEGIN Includes */3 c8 y* c' O1 j4 o+ t* O V# {
#include "stm32_timer.h"* G1 @: l$ e/ Z" ~3 H- k a: J
#include "stm32_seq.h"
. }: k# j1 ]) q) m1 e" `/ L
#include "utilities_def.h"9 z; ]- [ B) Z' ]1 I
#include "app_version.h". u: w5 ~( @1 U B, M" P
#include "subghz_phy_version.h"& V6 ^' o' l8 H$ D& v4 w$ }4 A
/* USER CODE END Includes */$ ~' {! {9 ] ]
/ @- d% z- S) q+ O5 }8 l
/* External variables ---------------------------------------------------------*/* i/ ?- h6 `- N/ Y, O3 H6 |
/* USER CODE BEGIN EV */- b& y) W3 w: ?
$ p' h' @* `( @+ i" ?5 h2 ]9 ^( K2 l
/* USER CODE END EV */
8 E, t+ |3 @7 j) u9 P' v4 j
0 I1 P1 ^& z& ]2 e+ i, I* w
/* Private typedef -----------------------------------------------------------*/& O/ Y, p3 `2 V, n/ W# l' E# Z
$ v4 r) y( u' ?8 ?5 P- Y, i* V, J
/* USER CODE BEGIN PTD */( q3 z1 I, F S0 `% C: }
typedef enum
: c+ J' F) j8 }. j' i# N
{
3 a& W& q7 Q8 w/ P5 Z1 }: l) O
RX,' p& Z2 U% a0 |
RX_TIMEOUT,
. f0 a$ E2 q9 ] }
RX_ERROR, P" c5 f$ q( d! l; t
TX,8 [: T' R/ D8 C! i/ w2 D; C! r
TX_TIMEOUT," [" i) l2 l) U. n( J
} States_t; C/ U% w4 n( ~- S' X9 c
/* USER CODE END PTD */# G% {* a+ F$ l1 H2 C* l
. y: A! S7 i3 p v
/* Private define ------------------------------------------------------------*/( h' L% K- p% x6 ]' X/ t
/* USER CODE BEGIN PD */8 l# }" }2 z m5 w. Z1 X
/* Configurations */, C5 a- L+ V3 U" w$ Q7 @4 l
/*Timeout*/) R# E5 D7 P5 ^9 \
#define RX_TIMEOUT_VALUE 3000
" a: r8 N- ~5 |7 v+ q- f$ |
#define TX_TIMEOUT_VALUE 3000- t6 M1 j+ [: t: E y
/* PING string*/! b1 v G, Y9 l' M
#define PING "PING", X7 U H/ ^8 ^
/* PONG string*/
0 S6 p$ r& ^0 V. {
#define PONG "PONG"
7 d9 Z' J6 ]+ J4 f9 H
/*Size of the payload to be sent*/) v! e5 x$ c; v/ z
/* Size must be greater of equal the PING and PONG*/; ^1 w( }2 n: I6 ^, G
#define MAX_APP_BUFFER_SIZE 2551 |* z" x( V# J4 m& ^: F9 ~1 `
#if (PAYLOAD_LEN > MAX_APP_BUFFER_SIZE)
2 i; {/ |5 T: a- w5 |) _- T
#error PAYLOAD_LEN must be less or equal than MAX_APP_BUFFER_SIZE8 G/ O/ f1 `' l
#endif /* (PAYLOAD_LEN > MAX_APP_BUFFER_SIZE) */
; y# C$ A8 _7 X: {
/* wait for remote to be in Rx, before sending a Tx frame*/
. m0 P, \8 e. ?# I8 ?8 `! q: P
#define RX_TIME_MARGIN 200
) V% B% r! L( b, ~$ h
/* Afc bandwidth in Hz */
, Q0 Z% S( f7 q( ]" A
#define FSK_AFC_BANDWIDTH 83333
& O1 H/ z X8 D9 g% P5 ]
/* LED blink Period*/
* Z1 Y+ p- Z1 R7 e2 {: v V( _2 J
#define LED_PERIOD_MS 2006 z; M5 a7 r/ M( x" @2 r0 ]2 T3 f
/* USER CODE END PD */
$ ?! Z: d; ?( A, r
/ r( O* }; \$ j j3 u% d
/* Private macro -------------------------------------------------------------*/$ B# H# c4 O2 a* `2 H6 ^
/* USER CODE BEGIN PM */
! j( s' R5 c1 c# H% X# K; [8 j
) Z, ?6 _/ W- O. {, K
/* USER CODE END PM */
: {0 q8 D- m# [, n4 c* w
3 X6 ]; I/ g, i- N6 W, S0 c9 I
/* Private variables ---------------------------------------------------------*/
. e. @ i) Q, h4 s' J, o. V# Y
/* Radio events function pointer */
0 f% l# T& v! _7 [- C
static RadioEvents_t RadioEvents;, a% t" X+ E% g2 o6 R2 ~
/* USER CODE BEGIN PV */
8 K; n, x8 q5 R4 F
/*Ping Pong FSM states */6 C1 `! Y0 X! W2 j8 k5 X! k
static States_t State = RX;
0 Q/ q8 T9 h, v" j
/* App Rx Buffer*/
* J+ u- U( \7 Z/ ?% E. v
static uint8_t BufferRx[MAX_APP_BUFFER_SIZE];
4 T- X6 ?2 l/ d+ S# l; q
/* App Tx Buffer*/6 h8 a5 u- i5 l% X' w- P4 W# B8 o1 _
static uint8_t BufferTx[MAX_APP_BUFFER_SIZE];0 s; G3 V& S! b( t, @0 J
/* Last Received Buffer Size*/
6 H9 ]1 v/ @" Q$ l8 \( [! T
uint16_t RxBufferSize = 0;
/* Last Received packer Rssi*/: S8 j# T) ^8 A; j
int8_t RssiValue = 0;6 m% }$ l3 R: K, o" ~8 h
/* Last Received packer SNR (in Lora modulation)*/
3 k8 L, U7 {- S
int8_t SnrValue = 0;
+ I+ G: K$ T) { |
/* Led Timers objects*/& n' a" C3 E+ D/ K% S- r) h
static UTIL_TIMER_Object_t timerLed;" M1 R- Y1 M* Z8 s) ]9 U
/* device state. Master: true, Slave: false*/3 Q' {' y9 h7 ^0 ]
bool isMaster = true;' J- z) q! O3 u6 T6 \1 T
/* random delay to make sure 2 devices will sync*/
c8 Z# d S% J" n4 Q5 a
/* the closest the random delays are, the longer it will8 M0 P- I$ v% m$ |
take for the devices to sync when started simultaneously*/& A2 ?1 z: y3 T5 m, U
static int32_t random_delay;
1 o4 x( Q' _$ @1 x2 E/ n( H
/* USER CODE END PV */
* m" @& {/ |1 Q+ I
" r6 `9 f: {/ D; y# h, w; b
/* Private function prototypes -----------------------------------------------*/- l" B+ B% K$ K$ ~4 v
/*!6 @4 x. Q+ r l# C' B6 p
* @brief Function to be executed on Radio Tx Done event6 X7 N! |- V) p( C# V, }/ T! D1 O
*/, M' g. O, E1 q. H
static void OnTxDone(void);
9 e/ e8 h6 O, z6 Y/ i
# d% H3 b. N/ H
/**
& q: S& n* R/ d, g0 J
* @brief Function to be executed on Radio Rx Done event+ f8 [: o) M5 g0 @- F4 E
* @param payload ptr of buffer received
$ b8 P! g( q, ?' e/ p* |
* @param size buffer size; l0 I; i: x% ^' n, R
* @param rssi i8 w1 E* @6 c1 Q M2 b
* @param LoraSnr_FskCfo
5 Z. w0 P: V& Y2 n @1 j
*/) ]: n( v8 i: u2 _ Z$ S8 l
static void OnRxDone(uint8_t *payload, uint16_t size, int16_t rssi, int8_t LoraSnr_FskCfo);: b2 c+ Z% X' \: M. p2 f! v v2 j/ k
8 d' E$ C* i, \- A
/**
, l/ N4 o) D0 t& ]
* @brief Function executed on Radio Tx Timeout event
* D% H) w/ L- N9 H4 z. A
*/
* w# v2 g8 I1 _* Q: V
static void OnTxTimeout(void);
e1 G$ ]3 x9 H. W c8 C# `
& [# B: Y: ^- J5 l( k4 J
/**1 `( W% S+ s, G1 N5 ` n% k) o% B
* @brief Function executed on Radio Rx Timeout event
- I1 j! E4 q8 x& p$ W/ ?) i6 K
*/" k$ Q# G$ q/ w
static void OnRxTimeout(void);
5 T4 `- S: Z+ P; f% Y! x. s- G' B* r
7 T) B) b# R1 W' C1 C2 C
/**
$ p! V' O. \5 F0 x4 y
* @brief Function executed on Radio Rx Error event; B/ H$ w7 W1 {, k4 F+ |$ |8 }
*/! w6 X- z5 [2 j' q% k
static void OnRxError(void);% q, v2 Y, n: Y4 G* l1 a( A! J$ y
# [) S* A) X. { Q+ S+ o
/* USER CODE BEGIN PFP */! o5 H; h: Y7 R" J' t7 K2 ?
/**8 d. P# }1 N) l9 C" O& e1 v+ g/ v- k
* @brief Function executed on when led timer elapses7 I2 D' S( R; X
* @param context ptr of LED context
" Z7 _% W6 ~5 G/ |7 L# g3 a
*/
: q+ _( X+ b7 |
static void OnledEvent(void *context);; O \. y8 }1 g
8 x3 r: O" h' l+ ]$ j
/**" o G+ Q% n2 P
* @brief PingPong state machine implementation
$ {( K% ~- A+ `& `0 c H, C) _; n
*/
I1 k6 L) u" Z
static void PingPong_Process(void);
% b9 w2 _5 ^8 ?
/* USER CODE END PFP */
+ x2 @ l ^( l1 V( E3 X
# h4 J: F2 ] V1 h! N" C# Q% J
/* Exported functions ---------------------------------------------------------*/" ^0 p2 ?% m1 N0 Z. e
void SubghzApp_Init(void)
5 q1 f. \% U6 m: \ J
{' H: C, P4 c* q' C' x7 V
/* USER CODE BEGIN SubghzApp_Init_1 */4 P3 g& j4 V. F5 s$ H, }6 x5 g* f
APP_LOG(TS_OFF, VLEVEL_M, "\n\rPING PONG\n\r");" J: y3 ?' Q T7 m" n, g2 O6 O
/* Get SubGHY_Phy APP version*/$ S' U/ G8 I, A" \
APP_LOG(TS_OFF, VLEVEL_M, "APPLICATION_VERSION: V%X.%X.%X\r\n",
4 v. g# i# U& S, _( |+ e
(uint8_t)(APP_VERSION_MAIN),9 c! @7 q9 T- U: T$ @, ?5 \" Q
(uint8_t)(APP_VERSION_SUB1),
4 J( i4 W" \ b% f0 H+ d
(uint8_t)(APP_VERSION_SUB2));
- b& a6 \" U( |% t+ i' u) W3 L% ~, K
) m z% x0 G3 `9 T
/* Get MW SubGhz_Phy info */
: W) G# `) E- d7 r1 w# [
APP_LOG(TS_OFF, VLEVEL_M, "MW_RADIO_VERSION: V%X.%X.%X\r\n",; s9 o. U; H- @: j# e# p) z
(uint8_t)(SUBGHZ_PHY_VERSION_MAIN),6 S [) b$ a5 \% X( _
(uint8_t)(SUBGHZ_PHY_VERSION_SUB1),
- B; `- ]6 `* I4 t- _! T
(uint8_t)(SUBGHZ_PHY_VERSION_SUB2));
) Y) F9 Y. _ W5 l3 R% O
+ ^% V+ ~6 Y+ K
/* Led Timers*/
0 Y) g. s7 \$ o/ Z3 Y. s
UTIL_TIMER_Create(&timerLed, LED_PERIOD_MS, UTIL_TIMER_ONESHOT, OnledEvent, NULL);( y: }. x1 f) c0 E& ~: O7 n
UTIL_TIMER_Start(&timerLed);
; M7 R6 {* E$ h: w# R
/* USER CODE END SubghzApp_Init_1 */+ n) ?* F a% s( t, x2 r: V
- @8 ~3 ^3 M! H+ J [9 R
/* Radio initialization */: q" f( L) a, B2 w& E9 l% g
RadioEvents.TxDone = OnTxDone;
; P1 m, o. {7 X7 P- R$ m+ E
RadioEvents.RxDone = OnRxDone;& b% Z7 z/ a# ^: U$ q' q S
RadioEvents.TxTimeout = OnTxTimeout;$ q- m1 T/ ^$ Y' D
RadioEvents.RxTimeout = OnRxTimeout;
- d! P) e" m* ^5 M& e; h
RadioEvents.RxError = OnRxError;
, A6 y3 s. V; K0 M
4 I; E0 W. V# f* Y3 g4 ~
Radio.Init(&RadioEvents);, a2 M1 X, z% P: A2 H. u
0 R ]/ n+ z ?
/* USER CODE BEGIN SubghzApp_Init_2 */+ l7 V3 U' C0 m, {
/*calculate random delay for synchronization*/
6 y b( k$ ?! K. o0 q' J# m
random_delay = (Radio.Random()) >> 22; /*10bits random e.g. from 0 to 1023 ms*/
* g" |0 z" E, Q. @6 L. v3 _. {
4 u+ d, O5 n1 | `* W8 ~8 G
/* Radio Set frequency */* s7 T a( ^6 V. `1 N" x/ w- Q E
Radio.SetChannel(RF_FREQUENCY);
. a6 p# U2 S1 P' u& Z
. c5 s* C7 _0 N3 w% `5 s
/* Radio configuration */$ T( h. I j4 x2 G
#if ((USE_MODEM_LORA == 1) && (USE_MODEM_FSK == 0))' ?, S: S6 }3 m2 V: M3 a3 m
APP_LOG(TS_OFF, VLEVEL_M, "---------------\n\r");0 g( h8 y" ^; m5 a- C9 b
APP_LOG(TS_OFF, VLEVEL_M, "LORA_MODULATION\n\r");6 @" \/ s9 |2 Z7 ^
APP_LOG(TS_OFF, VLEVEL_M, "LORA_BW=%d kHz\n\r", (1 << LORA_BANDWIDTH) * 125);
, ~9 |8 s- |% q0 {8 Z
APP_LOG(TS_OFF, VLEVEL_M, "LORA_SF=%d\n\r", LORA_SPREADING_FACTOR);: ^& T0 x; y3 Q! d% X n
$ }6 T A% |0 _( ^
Radio.SetTxConfig(MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH,
- H8 d' o" f2 I) k
LORA_SPREADING_FACTOR, LORA_CODINGRATE,
, ]% k2 \5 Q1 j- \9 G& M
LORA_PREAMBLE_LENGTH, LORA_FIX_LENGTH_PAYLOAD_ON,
1 D$ Y" r: e7 E; y$ @% u" a% X
true, 0, 0, LORA_IQ_INVERSION_ON, TX_TIMEOUT_VALUE);
u0 U$ Y- T$ c8 M+ o
+ L, I/ f2 F3 T% g; V4 X3 [; B
Radio.SetRxConfig(MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR,
+ J0 s3 V6 u+ j9 L7 T5 X `9 [
LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH,% F: M: P" q3 B2 \ e/ T
LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON,3 x) t3 K8 B' n8 F- x
0, true, 0, 0, LORA_IQ_INVERSION_ON, true);, V' [" e8 ]+ N5 ]0 S
. z; ?5 X0 Y, g! D
Radio.SetMaxPayloadLength(MODEM_LORA, MAX_APP_BUFFER_SIZE);$ t4 T7 a7 d# M% v0 a# `
7 K9 R! ?5 @+ z. n9 C1 T; p% A
#elif ((USE_MODEM_LORA == 0) && (USE_MODEM_FSK == 1))( m$ N, ` R! F9 B2 _- m0 [( E9 f
APP_LOG(TS_OFF, VLEVEL_M, "---------------\n\r");
8 }3 `1 r: M: W% Z/ }3 O7 K* L
APP_LOG(TS_OFF, VLEVEL_M, "FSK_MODULATION\n\r"); N8 ~4 W- R, A7 [
APP_LOG(TS_OFF, VLEVEL_M, "FSK_BW=%d Hz\n\r", FSK_BANDWIDTH);
" v9 I! j! ?4 z- O
APP_LOG(TS_OFF, VLEVEL_M, "FSK_DR=%d bits/s\n\r", FSK_DATARATE);
. \) Z4 s F6 ]4 _3 e5 Z
! h' W1 v: V4 X4 K0 {$ h
Radio.SetTxConfig(MODEM_FSK, TX_OUTPUT_POWER, FSK_FDEV, 0,
2 Y. J/ y9 E5 V$ i
FSK_DATARATE, 0,1 z( _" E F# e$ ~% i# t
FSK_PREAMBLE_LENGTH, FSK_FIX_LENGTH_PAYLOAD_ON,: S5 J, ^) L1 h3 H
true, 0, 0, 0, TX_TIMEOUT_VALUE);
; s8 D. H J4 `$ k p
+ Z0 x* X, B, i) K3 s8 [4 q, p- U
Radio.SetRxConfig(MODEM_FSK, FSK_BANDWIDTH, FSK_DATARATE,! i% Q: X/ b+ W. P4 b; l
0, FSK_AFC_BANDWIDTH, FSK_PREAMBLE_LENGTH," o& W9 r& y* E: x1 F: T. _$ \
0, FSK_FIX_LENGTH_PAYLOAD_ON, 0, true,* h( Y. Z; j: i9 Y& p
0, 0, false, true);
P8 Z+ m( x6 U
8 F7 c" A" k! F1 |8 r4 R' C! E
Radio.SetMaxPayloadLength(MODEM_FSK, MAX_APP_BUFFER_SIZE);
3 ?. P z: l: z* | Q
" C7 Y# j h, @) q+ _
#else2 R$ K4 [. ?3 u$ S
#error "Please define a modulation in the subghz_phy_app.h file."
2 Z( o" W: h! N9 S$ x( y
#endif /* USE_MODEM_LORA | USE_MODEM_FSK */
# }& O o; r2 J. M1 F
3 R& t2 M+ h! A/ t
/*fills tx buffer*/- N3 y3 A0 F5 g; D# h3 T+ D9 c
memset(BufferTx, 0x0, MAX_APP_BUFFER_SIZE);! b7 D/ f+ ~& A4 n1 \+ Z1 P4 N5 y, N' W
) y+ p- F2 X# g, s8 k0 K% ^
APP_LOG(TS_ON, VLEVEL_L, "rand=%d\n\r", random_delay);
7 Z P$ a- m; z
/*starts reception*/
7 f( M- D+ D) J$ S5 Q0 ]6 i
Radio.Rx(RX_TIMEOUT_VALUE + random_delay);8 H8 q+ |: k% l6 k: t; v
: U: r8 \$ O, u/ s0 x- E0 D
/*register task to to be run in while(1) after Radio IT*/
+ U; R5 X, R( a3 [# W9 z# T
UTIL_SEQ_RegTask((1 << CFG_SEQ_Task_SubGHz_Phy_App_Process), UTIL_SEQ_RFU, PingPong_Process);
0 K" V2 A* g# B% A1 P, [
/* USER CODE END SubghzApp_Init_2 */0 q, l& Y9 {0 _5 e. X- N/ [
}' P& I8 F P' r8 n
% P0 S; l- p/ v4 P! @8 {" D/ {
/* USER CODE BEGIN EF */
2 {( |& f0 x2 t
8 i7 }) x& F4 t- t5 _5 A
/* USER CODE END EF */6 M6 q6 O8 ? d7 @, s( C5 c
4 p! Y+ f6 i) i; f0 k1 E! F
/* Private functions ---------------------------------------------------------*/
- k6 \+ r: z/ M8 c7 f! E+ l
static void OnTxDone(void)
; F7 Q& N: {* e8 P+ b4 i
{) Z# ?* y8 y7 Q2 R# W
/* USER CODE BEGIN OnTxDone */- | v0 l; d6 q( `( y
APP_LOG(TS_ON, VLEVEL_L, "OnTxDone\n\r");% C% b% m! n: O/ y) Y
/* Update the State of the FSM*/0 _1 u: a2 d: q- \8 L$ {! c5 ^
State = TX;% F% \: M/ L. P6 O! W0 j
/* Run PingPong process in background*/
- j: o# e/ R P# B
UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_SubGHz_Phy_App_Process), CFG_SEQ_Prio_0);
3 `+ y- K; J2 x' v* t: W$ q
/* USER CODE END OnTxDone */4 L* \& l+ c! |0 i- ~$ S; h
} F' A# w* F% R& O O
( S# d7 K+ L- k" M: u/ o
static void OnRxDone(uint8_t *payload, uint16_t size, int16_t rssi, int8_t LoraSnr_FskCfo)
7 P7 D3 e2 T" e6 ?6 _) ~; {9 v
{
1 l6 g- }9 ] s0 f% I& E
/* USER CODE BEGIN OnRxDone */! P5 h! R3 v! v! _: z, D" A
APP_LOG(TS_ON, VLEVEL_L, "OnRxDone\n\r");
. m. F2 V! M/ K" J/ r' W& s. F7 E5 V
#if ((USE_MODEM_LORA == 1) && (USE_MODEM_FSK == 0))
, N* n: e* b6 z$ H: }# M
APP_LOG(TS_ON, VLEVEL_L, "RssiValue=%d dBm, SnrValue=%ddB\n\r", rssi, LoraSnr_FskCfo);& m( ^ [- i0 T1 N3 x9 a
/* Record payload Signal to noise ratio in Lora*/
3 J& i+ a+ P4 a3 y, M
SnrValue = LoraSnr_FskCfo;9 B }( |% l1 v0 M# k# e6 e* [
#endif /* USE_MODEM_LORA | USE_MODEM_FSK */0 D }1 ^ q2 ]7 B v
#if ((USE_MODEM_LORA == 0) && (USE_MODEM_FSK == 1))
# D- s/ |* Z- j% C; T
APP_LOG(TS_ON, VLEVEL_L, "RssiValue=%d dBm, Cfo=%dkHz\n\r", rssi, LoraSnr_FskCfo);" m6 B z. |2 n; j( n
SnrValue = 0; /*not applicable in GFSK*/
) D* c( d u# k# ^
#endif /* USE_MODEM_LORA | USE_MODEM_FSK */! C5 G1 k/ @8 V$ i) h
/* Update the State of the FSM*/3 h9 D! G6 V% A2 {6 ]6 o
State = RX;: [. X: C3 [# G* G& D
/* Clear BufferRx*/. S0 L2 q/ S* l
memset(BufferRx, 0, MAX_APP_BUFFER_SIZE);
% w1 `6 t0 {2 A# Z0 n( Z
/* Record payload size*/! L' v- l: S( f& _5 y
RxBufferSize = size;
w6 @8 p5 l: I# A) n2 R- G
if (RxBufferSize <= MAX_APP_BUFFER_SIZE)
. x5 k6 w& i8 i7 V9 {+ H
{
5 x4 \- }9 R( A2 I7 p
memcpy(BufferRx, payload, RxBufferSize);7 N6 O: n9 N( t/ D; c( v7 c
}9 J5 j. `* H8 {5 w
/* Record Received Signal Strength*/1 i. `7 a+ t8 ^3 o% |
RssiValue = rssi;
9 L; C6 @8 I4 M* i) j- n. C
/* Record payload content*/
" s$ K3 b$ o h( G! U# X
APP_LOG(TS_ON, VLEVEL_H, "payload. size=%d \n\r", size);5 A- ]9 j! ~) O4 B& _* L
for (int i = 0; i < PAYLOAD_LEN; i++)5 O# m( c6 R! m2 h* o! w' `* b
{: x7 f+ S1 _+ K+ |
APP_LOG(TS_OFF, VLEVEL_H, "%02X", BufferRx);
4 K$ z u; W) K5 ]
if (i % 16 == 15)
6 S( P8 E3 Z5 \# l
{ ~. m, K( P" x) [6 B8 o
APP_LOG(TS_OFF, VLEVEL_H, "\n\r"); r7 [/ c/ G* C* }
}
; _/ \ ]& x8 i) M- a# X
}. z4 Q4 |- e5 T" R* |/ {$ G2 C
APP_LOG(TS_OFF, VLEVEL_H, "\n\r");
% [6 |. k2 s9 g7 @) Z8 ? @; S
/* Run PingPong process in background*/
6 F1 k; j2 O8 z, [
UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_SubGHz_Phy_App_Process), CFG_SEQ_Prio_0);6 g5 |7 G0 V2 I. c
/* USER CODE END OnRxDone */
' s c# E! E5 t8 Z" ^/ w
}
4 [/ b( u% i6 D3 v% P4 b+ L
$ ~/ @6 X$ Q+ f1 J
static void OnTxTimeout(void)5 v- \; C, I! M9 j) D1 Y( H
{
0 l4 O L2 n7 y' E! K/ u5 n0 O
/* USER CODE BEGIN OnTxTimeout */& u7 ^6 P. H3 z, @& u
APP_LOG(TS_ON, VLEVEL_L, "OnTxTimeout\n\r");
# k5 u. A" S" j5 S" d% ?
/* Update the State of the FSM*/
" d+ @. J, O, L3 N( D0 G" [
State = TX_TIMEOUT;
3 q6 N7 j! D, V7 Q6 E' F- a3 r- B* e
/* Run PingPong process in background*/
9 V4 r/ Y$ G: u% F% m
UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_SubGHz_Phy_App_Process), CFG_SEQ_Prio_0);1 k3 w4 X5 r# B3 r/ Y& E
/* USER CODE END OnTxTimeout */: S& J) c6 T6 H5 O2 n/ a5 U
}8 E5 j$ w5 w( C3 `5 g3 Q2 l# R
: o6 a8 S4 x/ ^
static void OnRxTimeout(void)8 ^. ^% E' z7 K0 K9 e
{$ |5 @: I H* X7 }7 b; O
/* USER CODE BEGIN OnRxTimeout */7 L: Z4 b0 O% a+ u7 u6 H
APP_LOG(TS_ON, VLEVEL_L, "OnRxTimeout\n\r");
5 B3 l: `- r& \* Y7 }
/* Update the State of the FSM*/( X2 d* ?' n( h
State = RX_TIMEOUT;
# M( b* Y; K/ ^5 Z: l& }0 i! F
/* Run PingPong process in background*/
, a$ Q' A3 J$ Y$ E- f" x! O( p+ R
UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_SubGHz_Phy_App_Process), CFG_SEQ_Prio_0);
z4 u. d/ D G2 K1 {
/* USER CODE END OnRxTimeout *// ]- h, X* C! W, E1 I) H
}
) {" z5 |) i! E7 M2 `
" i: w& t/ |4 r% l3 J; R+ P
static void OnRxError(void)/ i d$ }- @' O2 s; t6 ^
{4 W6 A# Q8 J: D9 p
/* USER CODE BEGIN OnRxError */1 ^! m% ~/ u N+ @% P8 a2 I# O
APP_LOG(TS_ON, VLEVEL_L, "OnRxError\n\r");
( U0 d" z5 i) a5 c9 k
/* Update the State of the FSM*/
9 r* X7 W7 m- L- w
State = RX_ERROR;
9 O7 ?+ x: S5 K: \6 k* S
/* Run PingPong process in background*/
5 `& c* K; Q" V; d6 b; o
UTIL_SEQ_SetTask((1 << CFG_SEQ_Task_SubGHz_Phy_App_Process), CFG_SEQ_Prio_0);5 z+ j* ] y5 T" q# J
/* USER CODE END OnRxError */) G4 I% e2 `* \. o, R
}1 L" s# A" \# G& z2 V) E
6 P. ^3 g2 Y& b5 T- s; S4 l- O
/* USER CODE BEGIN PrFD */
C! s0 R) U+ w4 k/ `) H
static void PingPong_Process(void)( e+ r5 i: z' ~5 `. W( o
{6 O: j6 ?2 R; X, ^
Radio.Sleep();: @# C5 s# z" g+ m
+ ]- ?# z' b/ l" z! _
switch (State)3 S' v+ R$ R. d4 o& j
{4 k- R' c( M0 C% n
case RX:
$ n" M# Z6 c& C" |7 }
+ C. G* e! u7 ^' E( i$ |
if (isMaster == true)# c9 {( T% }* R/ j
{5 ?! C* o0 \' i7 n, o; \4 r- T
if (RxBufferSize > 0). U: F5 P# g5 C. o$ e+ K
{0 s u) P M; G) s% e4 @! ?
if (strncmp((const char *)BufferRx, PONG, sizeof(PONG) - 1) == 0)
' r2 x0 Y7 v# p# m0 w
{$ m3 }4 Y; |% S0 [
UTIL_TIMER_Stop(&timerLed);2 o2 R9 j& E5 v# E& _
/* switch off green led */; w0 X1 {+ o1 T& l3 [ Q
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET); /* LED_GREEN */1 [/ s7 o1 [, L C" A H
/* master toggles red led */
/ h" x9 Q% G0 Y4 B
HAL_GPIO_TogglePin(LED3_GPIO_Port, LED3_Pin); /* LED_RED */
7 E1 n2 t1 S) J: l- W
/* Add delay between RX and TX */
9 Y& _4 a6 \# D( G! u0 M& f2 v
HAL_Delay(Radio.GetWakeupTime() + RX_TIME_MARGIN);, D4 _, Z9 M- O6 q' t8 F% h
/* master sends PING*/
: i5 [. T/ l0 u& A* L% x1 c
APP_LOG(TS_ON, VLEVEL_L, "..."
1 u6 p1 G$ Q- I) k& r5 m. _
"PING". @( k5 x; ?+ Y3 D- h. {2 S& \1 ^
"\n\r");
% F4 W# H' E( z S: N; F0 D
APP_LOG(TS_ON, VLEVEL_L, "Master Tx start\n\r");
9 F4 [: _& \& u* L, l
memcpy(BufferTx, PING, sizeof(PING) - 1);$ }; O) M2 \* \8 K: ^) \% W
Radio.Send(BufferTx, PAYLOAD_LEN);( V: s) g0 S% r% Z! R. d6 e3 z; m% G
}
7 E( \8 G+ D4 X/ d
else if (strncmp((const char *)BufferRx, PING, sizeof(PING) - 1) == 0)
9 b5 q- j, f0 `2 U4 w
{
3 W! w( B; S5 ?2 V1 V* J& m8 F% |4 b
/* A master already exists then become a slave */9 _2 R# a+ P% m0 @1 ~) k7 w& `. v$ |
isMaster = false;' u/ ^- { u" I
APP_LOG(TS_ON, VLEVEL_L, "Slave Rx start\n\r");
: k, p' s$ k+ J5 x4 L4 y5 t
Radio.Rx(RX_TIMEOUT_VALUE);
+ l2 K4 Y# J, v" T* B3 F+ J0 U- R
}
$ D4 y3 n( @0 ]" k+ Y
else /* valid reception but neither a PING or a PONG message */
+ [' C, I* _# w3 A+ X% V* ?6 _# K% @
{7 D& Q1 ?/ k2 M# D
/* Set device as master and start again *// C N. I1 l. R( j' g4 Y# T5 b- {
isMaster = true;
5 n' _' l4 K& p6 v; q
APP_LOG(TS_ON, VLEVEL_L, "Master Rx start\n\r");
# ^4 }( [' i8 ~3 M; u1 Z1 J
Radio.Rx(RX_TIMEOUT_VALUE);
: R2 F( {% B. |2 h+ R' i
}! G& C% L; {4 ?( I1 V
}
% U8 D ^' c0 \# {( N' |* L
}
E% q1 K6 M. w; p8 f- Z# T' @
else
3 C+ T( O9 R' a
{: h0 O. L; s5 G7 B6 X$ D
if (RxBufferSize > 0)
1 Z! `& [9 @# R- x' D/ m
{
0 `$ }1 f, @! e# D
if (strncmp((const char *)BufferRx, PING, sizeof(PING) - 1) == 0)7 G5 _5 B" U: r4 j3 A4 O/ \$ B. {
{7 k9 }. l2 @" \8 R1 U5 v C
UTIL_TIMER_Stop(&timerLed);
& Z; O, a2 X# U, B) }
/* switch off red led */
' V# i% f; U% a- F0 y
HAL_GPIO_WritePin(LED3_GPIO_Port, LED3_Pin, GPIO_PIN_RESET); /* LED_RED */
. X( I" y9 O) ~6 c$ e' @
/* slave toggles green led */! n$ n$ R' |/ b" u- h& O
HAL_GPIO_TogglePin(LED2_GPIO_Port, LED2_Pin); /* LED_GREEN */( t( o0 U/ n/ j; z( p9 u
/* Add delay between RX and TX */1 i! ]" B" ^& o6 s" \8 T2 M
HAL_Delay(Radio.GetWakeupTime() + RX_TIME_MARGIN);
& q4 O. o, B* H- j
/*slave sends PONG*/4 y; a. S; o8 j; P
APP_LOG(TS_ON, VLEVEL_L, "..."9 J% F* W9 D8 o8 W" q! o2 K
"PONG". a5 K2 q3 f0 ]% T) l h
"\n\r");7 l; n9 m/ A) x' K# c! ^
APP_LOG(TS_ON, VLEVEL_L, "Slave Tx start\n\r");- k) w! u! I. Z" ^( Q/ g
memcpy(BufferTx, PONG, sizeof(PONG) - 1);
4 J' L) S3 d2 _) b( {
Radio.Send(BufferTx, PAYLOAD_LEN);* Z( ^- |* ~- s0 }
}- ^% \( T( I+ r* \
else /* valid reception but not a PING as expected */6 r- `) ]4 k7 X+ ^/ r1 ^' k
{
( S+ k* V- s4 T2 ^
/* Set device as master and start again */
/ V# c t" D) e& M' y
isMaster = true;
7 P/ ~$ j, R& p9 N' a% V1 S: X
APP_LOG(TS_ON, VLEVEL_L, "Master Rx start\n\r");
9 J! _6 a9 P. W. K0 A: U
Radio.Rx(RX_TIMEOUT_VALUE);
, a3 K4 H3 _/ g1 o
}
- H$ A, [* j, {" g0 i/ j8 ]
}
5 U, R+ j; ^0 W) t
}6 N8 V# r% b7 P& ?
break;
1 Y. d* s) t" j: z' c
case TX:
3 v% w7 v/ C" o! L; Z
APP_LOG(TS_ON, VLEVEL_L, "Rx start\n\r");1 ^$ |/ c/ M9 {9 W# E X+ x3 f
Radio.Rx(RX_TIMEOUT_VALUE);1 ~5 n% i! V. v7 s# V$ O7 w. c. G
break;
" \* F3 R9 K7 e/ m1 J
case RX_TIMEOUT:5 `5 k0 f: W. d0 u
case RX_ERROR:0 y1 ~8 c! s; e9 n# }7 n9 _
if (isMaster == true)
5 C9 |6 C3 n# V8 h1 K) r
{
7 L) o ]: ?% @' [5 H
/* Send the next PING frame */# f% K/ X; x# C; _& X) V- g" B
/* Add delay between RX and TX*/
$ H" F0 y5 p5 v, A1 _! l
/* add random_delay to force sync between boards after some trials*/
! x% F4 H: X: A9 @5 I/ W: z
HAL_Delay(Radio.GetWakeupTime() + RX_TIME_MARGIN + random_delay);! j' f6 r" v: a7 B0 A$ ^ Q! F4 P& r L
APP_LOG(TS_ON, VLEVEL_L, "Master Tx start\n\r");
, L& N) `: z6 z
/* master sends PING*/
1 R9 U* a ^( \8 R" v8 E
memcpy(BufferTx, PING, sizeof(PING) - 1);
, @/ s. l* u3 |% G$ e0 b
Radio.Send(BufferTx, PAYLOAD_LEN);, F: ?# \/ W, H3 x' r
}
/ h( ?. d6 S& ?9 ]) b/ L6 b5 x, n
else
+ V8 B/ U- e1 q# m7 z, L
{9 n+ ]/ F( n* L" g2 B0 u' X" W: p
APP_LOG(TS_ON, VLEVEL_L, "Slave Rx start\n\r");
3 T* Y# x, C+ b; n B
Radio.Rx(RX_TIMEOUT_VALUE);+ x" j* v1 x3 g
}
3 u2 r0 S3 c2 l2 ~1 M$ R+ b
break;
- E# U9 A1 u3 ^' u4 k; A2 H5 }
case TX_TIMEOUT:
& }+ g0 y, d* x0 R" X+ O
APP_LOG(TS_ON, VLEVEL_L, "Slave Rx start\n\r");
% R# |- l0 M) K1 v7 L2 K$ B
Radio.Rx(RX_TIMEOUT_VALUE); M( y" }' o4 c* c; P
break;. w+ z* ~: |1 Z2 h( T3 L
default:; ]. w! o8 d* O! v S" d: `
break;/ r- Y. B& T/ T0 {) t
}
. e, [% l0 a. @
}
7 O" R4 s7 k; l7 e
+ {/ \3 \% @% w! t, h$ x0 S
static void OnledEvent(void *context)
" h6 p& m' G% C7 X! j- }8 r
{
( x& \2 J: t7 x4 a8 w, O
HAL_GPIO_TogglePin(LED2_GPIO_Port, LED2_Pin); /* LED_GREEN */
$ E9 Q O, R5 C( x
HAL_GPIO_TogglePin(LED3_GPIO_Port, LED3_Pin); /* LED_RED */9 _5 A/ H$ x7 ^( W: z) J# C
UTIL_TIMER_Start(&timerLed);
$ B8 A/ V D8 b k
}% {& C' r' D& c; G$ W! @) `, [' a
/* USER CODE END PrFD */