QuakeGod
2022-09-29 e1f35018c4dec304b00f50d9dbe12204fd57a623
Src/functions.c
@@ -123,7 +123,7 @@
   return(crc);
}
 
/* Table of CRC values for high杘rder byte */
/* Table of CRC values for high-order byte */
const uint8_t crctablehi[] = {
   0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81,
   0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,
@@ -144,7 +144,7 @@
   0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81,
   0x40
};
/* Table of CRC values for low杘rder byte */
/* Table of CRC values for low-order byte */
const uint8_t crctablelo[] = {
   0x00, 0xC0, 0xC1, 0x01, 0xC3, 0x03, 0x02, 0xC2, 0xC6, 0x06, 0x07, 0xC7, 0x05, 0xC5, 0xC4,
   0x04, 0xCC, 0x0C, 0x0D, 0xCD, 0x0F, 0xCF, 0xCE, 0x0E, 0x0A, 0xCA, 0xCB, 0x0B, 0xC9, 0x09,
@@ -180,26 +180,6 @@
   return (crchi << 8 | crclo);
}
 
const uint16_t crctalbeabs[] = {
   0x0000, 0xCC01, 0xD801, 0x1400, 0xF001, 0x3C00, 0x2800, 0xE401,
   0xA001, 0x6C00, 0x7800, 0xB401, 0x5000, 0x9C01, 0x8801, 0x4400
};
uint16_t crc16tablefast(const uint8_t *ptr, uint16_t len)
{
   uint16_t crc = 0xffff;
   uint16_t i;
   uint8_t ch;
   for (i = 0; i < len; i++) {
      ch = *ptr++;
      crc = crctalbeabs[(ch ^ crc) & 15] ^ (crc >> 4);
      crc = crctalbeabs[((ch >> 4) ^ crc) & 15] ^ (crc >> 4);
   }
   return crc;
}
void modbuscrc16test()
{
   printf("\n");
@@ -207,7 +187,7 @@
   printf("-----------------------------------------------------------------------\n");
   uint8_t crc16_data[] = { 0x01, 0x04, 0x04, 0x43, 0x6b, 0x58, 0x0e };   // expected crc value 0xD825.
   printf(" modbus crc16table test, expected value : 0xd825, calculate value : 0x%x\n", crc16table(crc16_data, sizeof(crc16_data)));
   printf(" modbus crc16tablefast test, expected value : 0xd825, calculate value : 0x%x\n", crc16tablefast(crc16_data, sizeof(crc16_data)));
//   printf(" modbus crc16tablefast test, expected value : 0xd825, calculate value : 0x%x\n", crc16tablefast(crc16_data, sizeof(crc16_data)));
   printf(" modbus crc16bitbybit test, expected value : 0xd825, calculate value : 0x%x\n", crc16bitbybit(crc16_data, sizeof(crc16_data)));
}
@@ -243,6 +223,19 @@
      return 0;
}
int Uart2RecvDMA(void * pBuf, int nSize)
{
   LL_DMA_DisableChannel(DMA1,LL_DMA_CHANNEL_5);
   LL_DMA_ConfigAddresses(DMA1,LL_DMA_CHANNEL_5, (uint32_t)&USART2->RDR,
         (uint32_t)pBuf, LL_DMA_DIRECTION_PERIPH_TO_MEMORY);
   LL_DMA_SetDataLength(DMA1,LL_DMA_CHANNEL_5,nSize);
   LL_DMA_EnableChannel(DMA1,LL_DMA_CHANNEL_5);
   Uart2Stat.DMARecvLen=nSize;
   Uart2Stat.Recving=1;
   LL_DMA_EnableIT_TC(DMA1,LL_DMA_CHANNEL_5);
   LL_USART_EnableDMAReq_RX(USART2);
   return 0;
}
int Uart2SendDMA(void * pData, int nSize)
{
   LL_DMA_DisableChannel(DMA1,LL_DMA_CHANNEL_4);
@@ -265,6 +258,22 @@
      }
      return 0;
}
void TriggerPendSV()
{
     SCB->ICSR=SCB_ICSR_PENDSVSET_Msk; //1<<SCB_ICSR_PENDSVSET_Pos;
}
void PendSvCallBack()
{
   if (Uart2Stat.bPacketRecved)
   {
      ParsePacket((pPacket)Uart2RecvBuf1,Uart2RecvBuf1DataLen);
      Uart2RecvBuf1DataLen=0;
      Uart2Stat.bPacketRecved=0;
      Uart2RecvDMA(Uart2RecvBuf1,sizeof(Uart2RecvBuf1));
   }
}
void Uart1SendDone()
{
   Uart1Stat.TcCount++;
@@ -275,9 +284,12 @@
{
      Uart1Stat.IdelCount++;
//      NVIC_SetPendingIRQ(PendSV_IRQn);
//     SCB->ICSR=SCB_ICSR_PENDSVSET_Msk; //1<<SCB_ICSR_PENDSVSET_Pos;
   if (Uart1RecvBuf1DataLen >0)
   {
      Uart1Stat.bPacketRecved=1;
//     SCB->ICSR=SCB_ICSR_PENDSVSET_Msk; //1<<SCB_ICSR_PENDSVSET_Pos;
//      KLParsePacket(Uart1RecvBuf1,Uart1RecvBuf1DataLen);
//      Uart1RecvBuf1DataLen=0;
   }
@@ -289,10 +301,12 @@
}
void Uart2RecvDone()
{
   Uart2RecvBuf1DataLen=sizeof(Uart2RecvBuf1) - LL_DMA_GetDataLength(DMA1,LL_DMA_CHANNEL_5);
   Uart2Stat.bPacketRecved=1;
   Uart2Stat.IdelCount++;
   ParsePacket((pPacket)Uart2RecvBuf1,Uart2RecvBuf1DataLen);
   Uart2RecvBuf1DataLen=0;
   if (Uart2RecvBuf1DataLen>0)
      TriggerPendSV();
   //   ParsePacket((pPacket)Uart2RecvBuf1,Uart2RecvBuf1DataLen);
}
int PutStr(char * str1, int len1)
@@ -315,11 +329,11 @@
}
int PutStr2(char * str1, int len1)
{
//   Uart1SendDMA(str1,len1);
   PushIn(&Uart2Stat.QTx,str1,len1);
   Uart2SendDMA(str1,len1);
//   PushIn(&Uart2Stat.QTx,str1,len1);
//   LL_USART_EnableIT_TXE(USART1);   
//   LL_USART_EnableIT_TC(USART1);    
   Uart2TriggerSendDMA();
//   Uart2TriggerSendDMA();
   return len1;
}
@@ -390,6 +404,7 @@
unsigned int Input165_8()
{
   int x1=0;
   __disable_irq();
   set165SL_0();   set165SL_1();
   unsigned int mask1=0x0080;
   volatile uint32_t * p1=&GPIOA->IDR;
@@ -405,12 +420,14 @@
      mask1>>=1;
      set165CLK_1();
   }
   __enable_irq();
   return x1;
}
unsigned int Input165(int nBit)
{
   int x1=0;
   __disable_irq();
   set165SL_0();   set165SL_1();
   unsigned int mask1=1<<(nBit-1);
   volatile uint32_t * p1=&GPIOA->IDR;
@@ -426,11 +443,12 @@
      mask1>>=1;
      set165CLK_1();
   }
   __enable_irq();
   return x1;
}
unsigned int Input165_R(int nBit)
{
   __disable_irq();
   set165SL_0();   set165SL_1();
   int nBytes = nBit /8;
   volatile uint32_t * p1=&GPIOA->IDR;
@@ -458,13 +476,14 @@
      }
      rdata.Bytes[i]=x1;
   }
   __enable_irq();
   return rdata.intvalue;
}
unsigned int Input165Cfg(int nBit)
{
   int x1=0;
   __disable_irq();
   set165SL_0();   set165SL_1();
   unsigned int mask1=1<<(nBit-1);
   volatile uint32_t * p1=&GPIOA->IDR;
@@ -480,6 +499,7 @@
      mask1>>=1;
      set165CLK_1();
   }
   __enable_irq();
   return x1;
}
@@ -601,12 +621,12 @@
   }
}
#define SRCLK_0() //LL_GPIO_ResetOutputPin(GPIOB,LL_GPIO_PIN_13)
#define SRCLK_1() //LL_GPIO_SetOutputPin(GPIOB,LL_GPIO_PIN_13)
#define STRCLK_0() LL_GPIO_ResetOutputPin(GPIOB,LL_GPIO_PIN_12)
#define STRCLK_1() LL_GPIO_SetOutputPin(GPIOB,LL_GPIO_PIN_12)
#define SER_0() //LL_GPIO_ResetOutputPin(GPIOB,LL_GPIO_PIN_15)
#define SER_1() //LL_GPIO_SetOutputPin(GPIOB,LL_GPIO_PIN_15)
#define SRCLK2_0() LL_GPIO_ResetOutputPin(GPIOB,LL_GPIO_PIN_13)
#define SRCLK2_1() LL_GPIO_SetOutputPin(GPIOB,LL_GPIO_PIN_13)
#define STRCLK2_0() LL_GPIO_ResetOutputPin(GPIOB,LL_GPIO_PIN_12)
#define STRCLK2_1() LL_GPIO_SetOutputPin(GPIOB,LL_GPIO_PIN_12)
#define SER2_0() LL_GPIO_ResetOutputPin(GPIOB,LL_GPIO_PIN_15)
#define SER2_1() LL_GPIO_SetOutputPin(GPIOB,LL_GPIO_PIN_15)
void Enable595(uchar bEnable)
{
@@ -619,52 +639,92 @@
//unsigned char i;
;//      74HC595输出程序,输出8位
//   cc=~0x3f;
   STRCLK_1();
   __disable_irq();
   STRCLK2_1();
   unsigned int mask1=0x0080;
   //volatile uint32_t * p1 = &GPIOB->BRR;
   //volatile uint32_t * p2 = &GPIOB->BSRR;
   for (;mask1;)
   {
      SRCLK_0();
      SRCLK2_0();
      //*p1=LL_GPIO_PIN_13;
      if (cc&mask1) {SER_1();}
      else {SER_0();}
      if (cc&mask1) {SER2_1();}
      else {SER2_0();}
      mask1>>=1;
      SRCLK_1();
      SRCLK2_1();
//      __nop();
      //*p2=LL_GPIO_PIN_13;
   }
   STRCLK_0();
   STRCLK_1();
   STRCLK2_0();
   STRCLK2_1();
   __enable_irq();
}
void Output595_16(unsigned int cc)
{
//unsigned char i;
;//      74HC595输出程序,输出8位
//   cc=~0x3f;
   STRCLK_1();
   __disable_irq();
   STRCLK2_1();
   unsigned int mask1=0x8000;
   //volatile uint32_t * p1 = &GPIOB->BRR;
   //volatile uint32_t * p2 = &GPIOB->BSRR;
   for (;mask1;)
   {
      SRCLK_0();
      SRCLK2_0();
      //*p1=LL_GPIO_PIN_13;
      if (cc&mask1) {SER_1();}
      else {SER_0();}
      if (cc&mask1) {SER2_1();}
      else {SER2_0();}
      mask1>>=1;
      SRCLK_1();
      SRCLK2_1();
//      __nop();
      //*p2=LL_GPIO_PIN_13;
   }
   STRCLK_0();
   STRCLK_1();
   STRCLK2_0();
   STRCLK2_1();
   __enable_irq();
}
void PutOutput(unsigned int Y)
{
//   Output595_16(Y);
   STRCLK_1();
   LL_SPI_TransmitData8(SPI2,Y);
#define STRCLK12_0() LL_GPIO_ResetOutputPin(GPIOB,LL_GPIO_PIN_7)
#define STRCLK12_1() LL_GPIO_SetOutputPin(GPIOB,LL_GPIO_PIN_7)
void PutOutputSPI1(unsigned int Y)
{
   __disable_irq();
   STRCLK12_1();
   LL_SPI_TransmitData8(SPI1,Y>>8);
   int i=0;
   while (LL_SPI_IsActiveFlag_TXE(SPI1) == RESET)
   {
   }
   KMem.SDD[28]=i;
   i=0;
   while (LL_SPI_IsActiveFlag_BSY(SPI1) == SET)
   {
      i++;
   }
   LL_SPI_TransmitData8(SPI1,Y);
   while (LL_SPI_IsActiveFlag_TXE(SPI1) == RESET)
   {
   }
   KMem.SDD[28]=i;
   i=0;
   while (LL_SPI_IsActiveFlag_BSY(SPI1) == SET)
   {
      i++;
   }
   KMem.SDD[30]=i;
      STRCLK12_0();
      STRCLK12_1();
   __enable_irq();
}
void PutOutputSPI2(unsigned int Y)
{
   __disable_irq();
   STRCLK2_1();
   LL_SPI_TransmitData8(SPI2,Y>>8);
   int i=0;
   while (LL_SPI_IsActiveFlag_TXE(SPI2) == RESET)
   {
@@ -675,14 +735,31 @@
   {
      i++;
   }   
   LL_SPI_TransmitData8(SPI2,Y);
   while (LL_SPI_IsActiveFlag_TXE(SPI2) == RESET)
   {
   }
   KMem.SDD[28]=i;
   i=0;
   while (LL_SPI_IsActiveFlag_BSY(SPI2) == SET)
   {
      i++;
   }
   KMem.SDD[30]=i;
      STRCLK_0();
      STRCLK_1();
      STRCLK2_0();
      STRCLK2_1();
   __enable_irq();
}
void PutOutput(unsigned int Y)
{
   PutOutputSPI2(Y);
   //Output595_16(Y);
}
#if (BOARD_TYPE == 9 || BOARD_TYPE == 10 )
//#pragma message("9,10")
   // 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)
@@ -691,7 +768,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)
@@ -713,6 +790,7 @@
//unsigned char i;
;//      74HC595输出程序,输出8位
//   cc=~0x3f;
   __disable_irq();
   STRCLK1_1();
   unsigned int mask1=0x8000;
   //volatile uint32_t * p1 = &GPIOB->BRR;
@@ -729,5 +807,6 @@
      //*p2=LL_GPIO_PIN_13;
   }
   STRCLK1_0();
   STRCLK1_1();
   STRCLK1_1();
   __enable_irq();
}