| | |
| | | static RadioEvents_t RadioEvents; |
| | | #define USE_MODEM_LORA |
| | | //#define USE_MODEM_FSK |
| | | #define REGION_CN779 |
| | | #define REGION_CN779 |
| | | uint32_t RxDutyCycle_RX_time =128; |
| | | uint32_t RxDutyCycle_SLEEP_time=256; |
| | | #define LORA_FREQUENCY0 470200000 |
| | | #define LORA_FREQUENCY1 471200000 |
| | | #define LORA_FREQUENCY2 472200000 |
| | | #define LORA_FREQUENCY3 473200000 |
| | | #define LORA_FREQUENCY4 474200000 |
| | | #if defined( REGION_AS923 ) |
| | | |
| | | #define RF_FREQUENCY 923000000 // Hz |
| | |
| | | #define TX_OUTPUT_POWER 22 // 22 dBm |
| | | |
| | | extern bool IrqFired; |
| | | |
| | | |
| | | extern uint8_t lora_yingda_flag; |
| | | uint16_t lora_yingda_num; |
| | | |
| | | |
| | | //bool EnableMaster=true;//主选择 |
| | |
| | | void OnTxTimeout( void ); |
| | | void OnRxTimeout( void ); |
| | | void OnRxError( void ); |
| | | |
| | | uint8_t lora_chongfuyingda_flag; |
| | | uint8_t Lora_rx_open_flag; |
| | | extern u32 Loratx_frequency; |
| | | void LedToggle(void) |
| | | |
| | | { |
| | | // HAL_GPIO_TogglePin(GPIOB, LED1_Pin); |
| | | } |
| | | void Lora_tx_mode( void ) |
| | | { |
| | | |
| | | Radio.SetChannel( Loratx_frequency ); |
| | | |
| | | Radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, 2, |
| | | 7, LORA_CODINGRATE,LORA_PREAMBLE_LENGTH_T, LORA_FIX_LENGTH_PAYLOAD_ON, |
| | | false, 0, 0, LORA_IQ_INVERSION_ON_T, 3000 ); |
| | | |
| | | } |
| | | void Lora_rx_open( void ) |
| | | { |
| | | if(Lora_rx_open_flag==1) |
| | |
| | | Lora_Init(); |
| | | Lora_rx_open_flag=0; |
| | | } |
| | | if(lora_yingda_flag&&lora_chongfuyingda_flag==0) |
| | | { |
| | | printf("Lora:%d %d\r\n",lora_yingda_flag,lora_chongfuyingda_flag); |
| | | lora_chongfuyingda_flag=1; |
| | | RadioEvents.TxDone = OnTxDone; |
| | | RadioEvents.RxDone = OnRxDone; |
| | | RadioEvents.TxTimeout = OnTxTimeout; |
| | | RadioEvents.RxTimeout = OnRxTimeout; |
| | | RadioEvents.RxError = OnRxError; |
| | | |
| | | Radio.Init( &RadioEvents ); |
| | | Radio.SetChannel( 500000000 ); |
| | | Radio.SetRxConfig( MODEM_LORA, 0, 7, |
| | | LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH_R, |
| | | LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, |
| | | 0, false, 0, 0, true, 1 ); |
| | | |
| | | SX126xClearIrqStatus( IRQ_RADIO_ALL ); |
| | | // Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time); |
| | | Radio.Rx( RX_TIMEOUT_VALUE ); |
| | | |
| | | |
| | | } |
| | | } |
| | | void OnTxDone( void ) |
| | | { |
| | | Lora_rx_open_flag=1; |
| | | { |
| | | LED_TB_OFF; |
| | | if(lora_yingda_num>1000) |
| | | { |
| | | lora_yingda_num=0; |
| | | lora_yingda_flag=1; |
| | | } |
| | | |
| | | if(lora_yingda_flag==0) |
| | | Lora_rx_open_flag=1; |
| | | else |
| | | {} |
| | | |
| | | } |
| | | |
| | | extern uint32_t lp_time; |
| | | uint32_t lora_txtime_old; |
| | | extern uint8_t frame_seq_nb2,rec_nearbase_num,ancidlist_num; |
| | | uint16_t RX_TIMEOUTs; |
| | | extern LPTIM_HandleTypeDef hlptim1; |
| | | uint16_t current_time,start_time,end_time; |
| | | void OnRxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr ) |
| | | uint16_t lora_recv_devid=0; |
| | | u32 id; |
| | | extern uint8_t Lora_tx_ancnum; |
| | | extern uint16_t Lora_tx_ancid[50]; |
| | | extern uint16_t Lora_tx_ancdist[50]; |
| | | uint8_t power_and_key=0; |
| | | extern u8 battary,button; |
| | | u8 lora_seq_nb2; |
| | | extern uint8_t stationary_flag; |
| | | extern uint8_t anjian_flag; |
| | | void Lora_tx_zubao( void ) |
| | | { |
| | | uint16_t checksum; |
| | | usart_send[2] = 0x22;//正常模式 |
| | | usart_send[3] = 9+Lora_tx_ancnum*4;//数据段长度 |
| | | memcpy(&usart_send[4],&dev_id,2); |
| | | usart_send[6] = lora_seq_nb2;//包序 |
| | | power_and_key=stationary_flag<<1;//把按键跟静止2合1,发出去 |
| | | power_and_key=power_and_key+anjian_flag;; |
| | | memcpy(usart_send+7,&bat_percent,1); |
| | | memcpy(usart_send+8,&power_and_key,1); |
| | | usart_send[9] = lora_yingda_flag;//lora等待应答位 |
| | | usart_send[10] = Lora_tx_ancnum; |
| | | // usart_send[9] = lora_yingda_flag; |
| | | memcpy(&usart_send[11],&Lora_tx_ancid,2*Lora_tx_ancnum); |
| | | memcpy(&usart_send[11+Lora_tx_ancnum*2],&Lora_tx_ancdist,2*Lora_tx_ancnum); |
| | | checksum = Checksum_u16(&usart_send[2],8+4*Lora_tx_ancnum); |
| | | memcpy(&usart_send[11+4*Lora_tx_ancnum],&checksum,2); |
| | | } |
| | | uint16_t current_count; |
| | | u16 Lora_recevcount; |
| | | extern uint8_t no_data_chongqi_num; |
| | | void OnRxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr ) |
| | | { |
| | | Lora_recevcount=HAL_LPTIM_ReadCounter(&hlptim1); |
| | | Lora_recevcount=Lora_recevcount+197;//197代表6ms |
| | | if(Lora_recevcount>=32768) |
| | | { |
| | | Lora_recevcount -=32768; |
| | | } |
| | | // HAL_GPIO_WritePin(GPIOA, GPIO_PIN_15, GPIO_PIN_SET); |
| | | BufferSize = size; |
| | | memcpy( RX_Buffer, payload, BufferSize ); |
| | | RssiValue = rssi; |
| | | SnrValue = snr; |
| | | |
| | | no_data_chongqi_num=0; |
| | | Radio.Standby(); |
| | | HAL_GPIO_WritePin(GPIOA, GPIO_PIN_15, GPIO_PIN_SET); |
| | | if(lora_yingda_flag) |
| | | { |
| | | memcpy(&lora_recv_devid,&RX_Buffer[4],2); |
| | | if(lora_recv_devid==dev_id) |
| | | { |
| | | |
| | | |
| | | } |
| | | } |
| | | if(lora_yingda_flag==0) |
| | | { |
| | | lora_chongfuyingda_flag=0; |
| | | // HAL_GPIO_WritePin(GPIOB, GPIO_PIN_2, GPIO_PIN_SET); |
| | | // Delay_Ms(10); |
| | | // HAL_GPIO_WritePin(GPIOB, GPIO_PIN_2, GPIO_PIN_RESET); |
| | | uint16_t i=0; |
| | | for(i=0;i<BufferSize;i++) |
| | | {printf("RXD %d:\r\n",RX_Buffer[i]);} |
| | | // for(i=0;i<BufferSize;i++) |
| | | {printf("R %d:\r\n",RX_Buffer[3]);} |
| | | RX_TIMEOUTs++; |
| | | printf("RX_num :%d\r\n",RX_TIMEOUTs); |
| | | // printf("RX_num :%d\r\n",RX_TIMEOUTs); |
| | | // start_time=HAL_LPTIM_ReadCounter(&hlptim1); |
| | | // end_time=start_time+((32768/1000)*20); |
| | | // if(end_time>=32768) |
| | | // {end_time-=32768;} |
| | | // current_time=HAL_LPTIM_ReadCounter(&hlptim1); |
| | | HAL_GPIO_WritePin(RADIO_NSS_GPIO_Port, RADIO_NSS_Pin, GPIO_PIN_SET); |
| | | // while(current_time<end_time||current_time>end_time+15000) |
| | | // { |
| | | // current_time=HAL_LPTIM_ReadCounter(&hlptim1); |
| | | Anchor_App(); |
| | | // } |
| | | HAL_GPIO_WritePin(RADIO_NSS_GPIO_Port, RADIO_NSS_Pin, GPIO_PIN_SET); //片选lora无效 |
| | | |
| | | HAL_GPIO_WritePin(RADIO_NSS_GPIO_Port, RADIO_NSS_Pin, GPIO_PIN_RESET); |
| | | delay_ms(10); |
| | | |
| | | Radio.SetChannel( 470200000 ); |
| | | Radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, 0, |
| | | 7, LORA_CODINGRATE,LORA_PREAMBLE_LENGTH_T, LORA_FIX_LENGTH_PAYLOAD_ON, |
| | | false, 0, 0, LORA_IQ_INVERSION_ON_T, 3000 ); |
| | | |
| | | Radio.Send( usart_send, 12+rec_nearbase_num*4); |
| | | // printf("RX_TIMEOUTs :%d\r\n",RX_TIMEOUTs); |
| | | // Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time); |
| | | // printf("RX_TIMEOUTs :XXXX\r\n"); |
| | | // Radio.Rx( RX_TIMEOUT_VALUE ); |
| | | // printf("Slave TXD XXXX\r\n"); |
| | | id = dwt_readdevid() ; |
| | | while (0xDECA0130!=id) |
| | | { |
| | | u8 iderror_count = 0; |
| | | id = dwt_readdevid() ; |
| | | if(iderror_count++>100) |
| | | { |
| | | //////// printf("UWB芯片ID错误"); |
| | | break; |
| | | } |
| | | } |
| | | //////// printf("Anchor_App\r\n"); |
| | | current_count=HAL_LPTIM_ReadCounter(&hlptim1); |
| | | while(current_count<Lora_recevcount||current_count>Lora_recevcount+16384) |
| | | { |
| | | current_count=HAL_LPTIM_ReadCounter(&hlptim1); |
| | | if(current_count<Lora_recevcount-300) |
| | | { |
| | | break; |
| | | } |
| | | } |
| | | // HAL_GPIO_WritePin(GPIOA, GPIO_PIN_15, GPIO_PIN_RESET); |
| | | Anchor_App(); |
| | | // HAL_GPIO_WritePin(GPIOA, GPIO_PIN_15, GPIO_PIN_RESET); |
| | | HAL_GPIO_WritePin(RADIO_NSS_GPIO_Port, RADIO_NSS_Pin, GPIO_PIN_RESET); //片选lora有效 |
| | | delay_ms(1); |
| | | // if(lp_time-lora_txtime_old>=1) |
| | | // { |
| | | // LED_TB_ON; |
| | | // lora_txtime_old=lp_time; |
| | | // lora_seq_nb2++; |
| | | // lora_yingda_num++; |
| | | // Lora_tx_zubao(); |
| | | // Lora_tx_mode(); |
| | | // Radio.Send( usart_send, 12+Lora_tx_ancnum*4); |
| | | // Lora_tx_ancnum=0; |
| | | // } |
| | | // else |
| | | // { |
| | | Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time); |
| | | // } |
| | | |
| | | |
| | | } |
| | | } |
| | | |
| | | void OnTxTimeout( void ) |
| | | { |
| | | |
| | | Radio.Standby(); |
| | | Lora_Init(); |
| | | Lora_rx_open_flag=0; |
| | | |
| | | Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time); |
| | | } |
| | | |
| | | void OnRxTimeout( void ) |
| | | { |
| | | Radio.Standby(); |
| | | if(EnableMaster) |
| | | { |
| | | // TX_Buffer[0] = 'P'; |
| | | // TX_Buffer[1] = 'I'; |
| | | // TX_Buffer[2] = 'N'; |
| | | // TX_Buffer[3] = 'G'; |
| | | // |
| | | //// crc_value=RadioComputeCRC(TX_Buffer,4,CRC_TYPE_IBM);//计算得出要发送数据包CRC值 |
| | | //// TX_Buffer[4]=crc_value>>8; |
| | | //// TX_Buffer[5]=crc_value; |
| | | // //Radio.Send( TX_Buffer, 6); |
| | | // Radio.Send( TX_Buffer, 4); |
| | | |
| | | // HAL_GPIO_WritePin( OUT1_GPIO_Port, OUT1_Pin,GPIO_PIN_SET); |
| | | // HAL_Delay_nMS( 1 ); |
| | | // HAL_GPIO_WritePin( OUT1_GPIO_Port, OUT1_Pin,GPIO_PIN_RESET); |
| | | printf("Master TXD PING!\r\n"); |
| | | } |
| | | else |
| | | { |
| | | Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time); |
| | | // printf("slave OnRxTimeout\r\n"); |
| | | |
| | | // Radio.Rx( RX_TIMEOUT_VALUE ); |
| | | printf("slave OnRxTimeout\r\n"); |
| | | } |
| | | Lora_Init(); |
| | | Lora_rx_open_flag=0; |
| | | |
| | | Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time); |
| | | // printf("slave OnRxTimeout\r\n"); |
| | | |
| | | } |
| | | |
| | | void OnRxError( void ) |
| | | { |
| | | |
| | | Radio.Standby(); |
| | | if(EnableMaster) |
| | | { |
| | | TX_Buffer[0] = 'P'; |
| | | TX_Buffer[1] = 'I'; |
| | | TX_Buffer[2] = 'N'; |
| | | TX_Buffer[3] = 'G'; |
| | | |
| | | // crc_value=RadioComputeCRC(TX_Buffer,4,CRC_TYPE_IBM);//计算得出要发送数据包CRC值 |
| | | // TX_Buffer[4]=crc_value>>8; |
| | | // TX_Buffer[5]=crc_value; |
| | | //Radio.Send( TX_Buffer, 6); |
| | | Radio.Send( TX_Buffer, 4); |
| | | // HAL_GPIO_WritePin( OUT1_GPIO_Port, OUT1_Pin,GPIO_PIN_SET); |
| | | // HAL_Delay_nMS( 1 ); |
| | | // HAL_GPIO_WritePin( OUT1_GPIO_Port, OUT1_Pin,GPIO_PIN_RESET); |
| | | printf("Master TXD PING!\r\n"); |
| | | } |
| | | else |
| | | { |
| | | Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time); |
| | | printf("slave OnRxError\r\n"); |
| | | // Radio.Rx( RX_TIMEOUT_VALUE ); |
| | | |
| | | } |
| | | |
| | | Lora_Init(); |
| | | Lora_rx_open_flag=0; |
| | | Radio.SetRxDutyCycle(RxDutyCycle_RX_time,RxDutyCycle_SLEEP_time); |
| | | } |
| | | |
| | | |
| | | |
| | | //void T_R_Init(uint8_t kind) |
| | | //{ |
| | | // Radio.Init( &RadioEvents ); |
| | | // if(kind==1) //1:Txd config |
| | | // { |
| | | // Radio.SetChannel( RF_FREQUENCY ); |
| | | // Radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH, |
| | | // LORA_SPREADING_FACTOR, LORA_CODINGRATE, |
| | | // LORA_PREAMBLE_LENGTH_T, LORA_FIX_LENGTH_PAYLOAD_ON, |
| | | // false, 0, 0, LORA_IQ_INVERSION_ON_T, 1000 ); |
| | | |
| | | // } |
| | | // else //0:Rxd config |
| | | // { |
| | | // Radio.SetChannel( RF_FREQUENCY ); |
| | | // Radio.SetRxConfig( MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR, |
| | | // LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH_R, |
| | | // LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, |
| | | // 0, false, 0, 0, LORA_IQ_INVERSION_ON_R, false ); |
| | | // } |
| | | // |
| | | //// Radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH, |
| | | //// LORA_SPREADING_FACTOR, LORA_CODINGRATE, |
| | | //// LORA_PREAMBLE_LENGTH_T, LORA_FIX_LENGTH_PAYLOAD_ON, |
| | | //// false, 0, 0, LORA_IQ_INVERSION_ON_T, 1000 ); |
| | | |
| | | //// Radio.SetRxConfig( MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR, |
| | | //// LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH_R, |
| | | //// LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, |
| | | //// 0, false, 0, 0, LORA_IQ_INVERSION_ON_R, false ); |
| | | //} |
| | | |
| | | void Lora_Init(void) |
| | | { |
| | |
| | | RadioEvents.TxTimeout = OnTxTimeout; |
| | | RadioEvents.RxTimeout = OnRxTimeout; |
| | | RadioEvents.RxError = OnRxError; |
| | | |
| | | // printf("Lora_Init3\r\n"); |
| | | Radio.Init( &RadioEvents ); |
| | | if(EnableMaster) |
| | | { |
| | | Radio.SetChannel( RF_FREQUENCY ); |
| | | } |
| | | else |
| | | { |
| | | Radio.SetChannel( RF_FREQUENCY ); |
| | | } |
| | | |
| | | // Radio.SetStandby( STDBY_RC ); |
| | | |
| | | // Radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH, |
| | |
| | | // LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH, |
| | | // LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, |
| | | // 0, true, 0, 0, LORA_IQ_INVERSION_ON, false ); |
| | | |
| | | // printf("Lora_Init1\r\n"); |
| | | Radio.SetRxConfig( MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR, |
| | | LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH_R, |
| | | LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, |
| | | 0, false, 0, 0, LORA_IQ_INVERSION_ON_R, 1 ); |
| | | |
| | | // Radio.SetRxConfig( MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR, |
| | | // LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH, |
| | | // LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, |
| | | // 0, false, 0, 0, LORA_IQ_INVERSION_ON, true ); |
| | | |
| | | if(EnableMaster) |
| | | { |
| | | |
| | | printf("I am Master!\r\n"); |
| | | |
| | | TX_Buffer[0] = 'P'; |
| | | TX_Buffer[1] = 'I'; |
| | | TX_Buffer[2] = 'N'; |
| | | TX_Buffer[3] = 'G'; |
| | | |
| | | crc_value=RadioComputeCRC(TX_Buffer,4,CRC_TYPE_IBM);//计算得出要发送数据包CRC值 |
| | | TX_Buffer[4]=crc_value>>8; |
| | | TX_Buffer[5]=crc_value; |
| | | //Radio.Send( TX_Buffer, 6); |
| | | Radio.Send( TX_Buffer, 4); |
| | | |
| | | // HAL_GPIO_WritePin( OUT1_GPIO_Port, OUT1_Pin,GPIO_PIN_SET); |
| | | // HAL_Delay_nMS( 1 ); |
| | | // HAL_GPIO_WritePin( OUT1_GPIO_Port, OUT1_Pin,GPIO_PIN_RESET); |
| | | |
| | | printf("Master TXD PING!\r\n"); |
| | | } |
| | | else |
| | | |
| | | |
| | | { |
| | | SX126xClearIrqStatus( IRQ_RADIO_ALL ); |
| | | // SX126xSetDioIrqParams( IRQ_RX_DONE | IRQ_CRC_ERROR, |
| | |
| | | // Radio.Rx( RX_TIMEOUT_VALUE ); |
| | | // printf("I am Slave!\r\n"); |
| | | } |
| | | |
| | | |
| | | } |