QuakeGod
2023-01-28 0917738f20328de743be272ce4b042945d701830
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的nS数,
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;每uS的时钟数
      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();