From 0917738f20328de743be272ce4b042945d701830 Mon Sep 17 00:00:00 2001
From: QuakeGod <QuakeGod@sina.com>
Date: 星期六, 28 一月 2023 15:41:25 +0800
Subject: [PATCH] Radio add channel jumpper config
---
Src/functions.c | 182 +++++++++++++++++++++++++++++++++++----------
1 files changed, 142 insertions(+), 40 deletions(-)
diff --git a/Src/functions.c b/Src/functions.c
index 8ba8fe2..feedbc0 100644
--- a/Src/functions.c
+++ b/Src/functions.c
@@ -8,6 +8,9 @@
#include "functions.h"
#include "string.h"
#include "stm32f0xx_hal.h"
+#if (BOARD_TYPE == 14)
+#include "fp0.h"
+#endif
extern __IO uint32_t uwTick;
//#include "Myprotocol.h"
int TickFreq=10000;
@@ -16,16 +19,16 @@
unsigned int TickPrioduS; //
volatile unsigned int nCurTick=0;
volatile unsigned int CurTickuS=0;
-//volatile unsigned int ThisRunTime=0; //开机时间
-//volatile unsigned int TotalRunTime=0; //总开机时间
-//volatile unsigned int PwrCount=0; //开机次数
-unsigned short ClkuS; //每个Clk的nS数，
+//volatile unsigned int ThisRunTime=0; //寮�鏈烘椂闂�
+//volatile unsigned int TotalRunTime=0; //鎬诲紑鏈烘椂闂�
+//volatile unsigned int PwrCount=0; //寮�鏈烘鏁�
+unsigned short ClkuS; //姣忎釜Clk鐨刵S鏁帮紝
int InituS(int TickFreq1)
{
- TickPrioduS=1000000/TickFreq1; //每个SysTick的微秒数
- CoreClkMHz=HAL_RCC_GetHCLKFreq()/1000000; //=SystemCoreClock/1000000;每uS的时钟数
- TickPriodClk=SystemCoreClock/TickFreq1; //每个SysTick的时钟数
+ TickPrioduS=1000000/TickFreq1; //姣忎釜SysTick鐨勫井绉掓暟
+ CoreClkMHz=HAL_RCC_GetHCLKFreq()/1000000; //=SystemCoreClock/1000000;姣弖S鐨勬椂閽熸暟
+ TickPriodClk=SystemCoreClock/TickFreq1; //姣忎釜SysTick鐨勬椂閽熸暟
ClkuS=(1000000LL*65536)/SystemCoreClock;
CurTickuS=TickPrioduS+100u;
return 0;
@@ -51,6 +54,7 @@
// unsigned short Clk1=SysTick->VAL;
return nCurTick;
}
+
const unsigned short crc16_table[256] = {
0x0000, 0x1189, 0x2312, 0x329b, 0x4624, 0x57ad, 0x6536, 0x74bf,
0x8c48, 0x9dc1, 0xaf5a, 0xbed3, 0xca6c, 0xdbe5, 0xe97e, 0xf8f7,
@@ -89,11 +93,11 @@
unsigned short crc_check(const unsigned char * data, unsigned int length)
{
unsigned short crc_reg = 0xFFFF;
-while (length--)
-{
-crc_reg = (crc_reg >> 8) ^ crc16_table[(crc_reg ^ *data++) & 0xff];
-}
-return (~crc_reg) & 0xFFFF;
+ while (length--)
+ {
+ crc_reg = (crc_reg >> 8) ^ crc16_table[(crc_reg ^ *data++) & 0xff];
+ }
+ return (~crc_reg) & 0xFFFF;
}
const uint16_t polynom = 0xA001;
@@ -266,14 +270,82 @@
void PendSvCallBack()
{
+#if (BOARD_TYPE == 14)
+///*
+ if (bSPI1RecvDone)
+ {
+ bSPI1RecvDone=0;
+ ParseFP0Pkg(SPI1RecvBuf,nSPI1RecvLenInBuf);
+ }
+//*/
+#endif
if (Uart2Stat.bPacketRecved)
{
- ParsePacket((pPacket)Uart2RecvBuf1,Uart2RecvBuf1DataLen);
+ KBusParsePacket(2, (pPacket)Uart2RecvBuf1, Uart2RecvBuf1DataLen);
Uart2RecvBuf1DataLen=0;
Uart2Stat.bPacketRecved=0;
Uart2RecvDMA(Uart2RecvBuf1,sizeof(Uart2RecvBuf1));
}
}
+
+void SPI1_IRQ_CallBack()
+{
+ uint8_t value;
+// LL_GPIO_TogglePin(GPIOB,LL_GPIO_PIN_7);
+ if (LL_SPI_IsActiveFlag_RXNE(SPI1))
+ {
+ value = LL_SPI_ReceiveData8( SPI1);
+#if (BOARD_TYPE == 14)
+ KMem.SDD[62]++;
+ KMem.SDT[122]++;
+ if (!bSPI1Sending)
+ {
+ KMem.SDB[128+KMem.SDT[123]] = value;
+ KMem.SDT[123]++; if (KMem.SDT[123]>=100) {KMem.SDT[123]=81;}
+ }
+ if (!bSPI1Sending && (1 || bSPI1Recving))
+ {
+ SPI1RecvBuf[nSPI1RecvPos]=value;
+ nSPI1RecvPos++;
+
+ if (value==0x0d)
+ {
+ KMem.SDB[128+KMem.SDT[123]] = nSPI1RecvPos;
+ KMem.SDT[123]++; if (KMem.SDT[123]>=100) {KMem.SDT[123]=81;}
+
+ nSPI1RecvLenInBuf=nSPI1RecvPos;
+ bSPI1RecvDone=1;
+ nSPI1RecvPos=0;
+ bSPI1Recving=0;
+
+
+ TriggerPendSV();
+ }
+ }
+ if (bSPI1Sending)
+ {
+ nSPI1SentLen++;
+ KMem.SDD[63]++;
+
+ if (nSPI1SentLen >= nSPI1ToSendLen) {
+ SetACKPin_1();
+ bSPI1Sending=0;
+ bSPI1SendDone=1;
+ bSPI1Recving=1;
+ nSPI1RecvPos=0;
+ SetFP0DEPin_0();
+ }
+ else {
+ value = SPI1SendBuf[nSPI1SentLen];
+ LL_SPI_TransmitData8(SPI1,value);
+ KMem.SDB[128+KMem.SDT[123]] = value;
+ KMem.SDT[123]++; if (KMem.SDT[123]>=100) {KMem.SDT[123]=81;}
+ }
+ }
+#endif
+ }
+}
+
void Uart1SendDone()
{
Uart1Stat.TcCount++;
@@ -312,10 +384,10 @@
int PutStr(char * str1, int len1)
{
// Uart1SendDMA(str1,len1);
- //PushIn(&Uart1Stat.QTx,str1,len1);
+ PushIn(&Uart1Stat.QTx,str1,len1);
// LL_USART_EnableIT_TXE(USART1);
// LL_USART_EnableIT_TC(USART1);
- //Uart1TriggerSendDMA();
+ Uart1TriggerSendDMA();
return len1;
}
int PutStr1(char * str1, int len1)
@@ -337,21 +409,22 @@
return len1;
}
-void clearscreen()
+int SendPacket(int nChn, void * pBuf,int len1)
{
- PutStr("\33[2J\33[0;0H",10);
- return;
+ if (nChn==1) {
+ PutStr1((char *)pBuf,len1);
+// PushIn(&Uart1Stat.QTx,p1,len1);
+// Uart1TriggerSendDMA();
+ Uart1Stat.SentPacket++;
+ }else if (nChn==2){
+ PutStr2((char *)pBuf,len1);
+// PushIn(&Uart2Stat.QTx,p1,len1);
+// Uart2TriggerSendDMA();
+ Uart2Stat.SentPacket++;
+ }
+ return len1;
}
-
-void Locate(int y,int x)
-{
- char str[16];
- int len;
- len=sprintf(str," \33[%d;%dH",y,x);
- PutStr(str,len);
- return;
-}
-
+/*
int SendPacket1(void * pBuf,int len1)
{
PutStr1((char *)pBuf,len1);
@@ -368,9 +441,18 @@
Uart2Stat.SentPacket++;
return len1;
}
-
+*/
void ToggleRunLed() { LL_GPIO_TogglePin(GPIOC,LL_GPIO_PIN_13);}
void ToggleErrLed() { LL_GPIO_TogglePin(GPIOC,LL_GPIO_PIN_14);}
+#if (BOARD_TYPE == 14)
+void ToggleOutStat() { LL_GPIO_TogglePin(GPIOC,LL_GPIO_PIN_15);}
+
+void SetOutStat(uchar bOn)
+{
+ if (bOn) {LL_GPIO_SetOutputPin(GPIOC,LL_GPIO_PIN_15);}
+ else {LL_GPIO_ResetOutputPin(GPIOC,LL_GPIO_PIN_15);}
+}
+#else
void ToggleOutStat() { LL_GPIO_TogglePin(GPIOA,LL_GPIO_PIN_11);}
void SetOutStat(uchar bOn)
@@ -378,6 +460,7 @@
if (bOn) {LL_GPIO_SetOutputPin(GPIOA,LL_GPIO_PIN_11);}
else {LL_GPIO_ResetOutputPin(GPIOA,LL_GPIO_PIN_11);}
}
+#endif
void SetRunLed(uchar bOn)
{
@@ -529,6 +612,12 @@
return Input165_R(8);
case 11:
return Input165_R(8);
+ case 13:
+ return Input165_R(16);
+ case 14:
+ return 0; //FP0
+ case 15:
+ return Input165_R(16);
default:
break;
}
@@ -612,9 +701,15 @@
return ReadConfig_5(); //New Slave 8 in 8 o
case 9:
case 10:
- return ReadConfig_5(); //New Slave 8 in 8 o
+ return ReadConfig_5(); //New Master Slave 8 in 8 o
case 11:
return ReadConfig_11(); //Mini Board
+ case 13:
+ return ReadConfig_5();
+ case 14:
+ return (~(LL_GPIO_ReadInputPort(GPIOA)>>4))&0x0f; //FP0
+ case 15:
+ return ReadConfig_5(); //Wireless Master Slave 8 in 8 o
default:
return 0;
@@ -637,7 +732,7 @@
void Output595_8(unsigned int cc)
{
//unsigned char i;
-;// 74HC595输出程序，输出8位
+;// 74HC595杈撳嚭绋嬪簭锛岃緭鍑�8浣�
// cc=~0x3f;
__disable_irq();
STRCLK2_1();
@@ -659,10 +754,11 @@
STRCLK2_1();
__enable_irq();
}
+
void Output595_16(unsigned int cc)
{
//unsigned char i;
-;// 74HC595输出程序，输出8位
+;// 74HC595杈撳嚭绋嬪簭锛岃緭鍑�8浣�
// cc=~0x3f;
__disable_irq();
STRCLK2_1();
@@ -685,6 +781,7 @@
__enable_irq();
}
+/*
#define STRCLK12_0() LL_GPIO_ResetOutputPin(GPIOB,LL_GPIO_PIN_7)
#define STRCLK12_1() LL_GPIO_SetOutputPin(GPIOB,LL_GPIO_PIN_7)
@@ -715,10 +812,11 @@
}
KMem.SDD[30]=i;
STRCLK12_0();
- STRCLK12_1();
- __enable_irq();
+ __nop();
+ STRCLK12_1();
+ __enable_irq();
}
-
+*/
void PutOutputSPI2(unsigned int Y)
{
@@ -747,19 +845,22 @@
}
KMem.SDD[30]=i;
STRCLK2_0();
- STRCLK2_1();
+ STRCLK2_1();
__enable_irq();
}
void PutOutput(unsigned int Y)
{
+#if (BOARD_TYPE == 14)
+ return ;
+#endif
PutOutputSPI2(Y);
//Output595_16(Y);
}
-#if (BOARD_TYPE == 9 || BOARD_TYPE == 10 )
+#if (BOARD_TYPE == 9 || BOARD_TYPE == 10 || BOARD_TYPE == 15 )
//#pragma message("9,10")
- // V4.2 管脚排列向右移动了一位。
+ // V4.2 绠¤剼鎺掑垪鍚戝彸绉诲姩浜嗕竴浣嶃��
#define SRCLK1_0() LL_GPIO_ResetOutputPin(GPIOB,LL_GPIO_PIN_1)
#define SRCLK1_1() LL_GPIO_SetOutputPin(GPIOB,LL_GPIO_PIN_1)
#define STRCLK1_0() LL_GPIO_ResetOutputPin(GPIOB,LL_GPIO_PIN_2)
@@ -768,7 +869,7 @@
#define OE1_1() LL_GPIO_SetOutputPin(GPIOB,LL_GPIO_PIN_10)
#define SER1_0() LL_GPIO_ResetOutputPin(GPIOB,LL_GPIO_PIN_11)
#define SER1_1() LL_GPIO_SetOutputPin(GPIOB,LL_GPIO_PIN_11)
-#else //按照原来的管脚排列
+#else //鎸夌収鍘熸潵鐨勭鑴氭帓鍒�
#define SRCLK1_0() LL_GPIO_ResetOutputPin(GPIOB,LL_GPIO_PIN_0)
#define SRCLK1_1() LL_GPIO_SetOutputPin(GPIOB,LL_GPIO_PIN_0)
#define STRCLK1_0() LL_GPIO_ResetOutputPin(GPIOB,LL_GPIO_PIN_1)
@@ -785,10 +886,11 @@
if (bEnable) {OE1_0();}
else {OE1_1();}
}
+
void displayInput(unsigned int cc)
{
//unsigned char i;
-;// 74HC595输出程序，输出8位
+;// 74HC595杈撳嚭绋嬪簭锛岃緭鍑�8浣�
// cc=~0x3f;
__disable_irq();
STRCLK1_1();
--
Gitblit v1.9.1