| | |
|---|
| | | #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;
|
|---|
| | |
|---|
| | | 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;
|
|---|
| | |
|---|
| | | // unsigned short Clk1=SysTick->VAL;
|
|---|
| | | return nCurTick;
|
|---|
| | | }
|
|---|
| | |
|
|---|
| | | void logData(unsigned char d)
|
|---|
| | | {
|
|---|
| | | KMem.WDB[128+KMem.WDT[123]] = d;
|
|---|
| | | KMem.WDT[123]++; if (KMem.WDT[123]>=100) {KMem.WDT[123]=81;} |
|---|
| | | }
|
|---|
| | |
|
|---|
| | | const unsigned short crc16_table[256] = {
|
|---|
| | | 0x0000, 0x1189, 0x2312, 0x329b, 0x4624, 0x57ad, 0x6536, 0x74bf,
|
|---|
| | | 0x8c48, 0x9dc1, 0xaf5a, 0xbed3, 0xca6c, 0xdbe5, 0xe97e, 0xf8f7,
|
|---|
| | |
|---|
| | | 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;
|
|---|
| | |
|---|
| | | LL_DMA_SetDataLength(DMA1,LL_DMA_CHANNEL_2,nSize);
|
|---|
| | | LL_DMA_EnableChannel(DMA1,LL_DMA_CHANNEL_2);
|
|---|
| | | Uart1Stat.DMASendLen=nSize;
|
|---|
| | | Uart1Stat.Sending=1; |
|---|
| | | Uart1Stat.bSending=1; |
|---|
| | | LL_DMA_EnableIT_TC(DMA1,LL_DMA_CHANNEL_2);
|
|---|
| | | LL_USART_EnableDMAReq_TX(USART1);
|
|---|
| | | return nSize;
|
|---|
| | |
|---|
| | |
|
|---|
| | | int Uart1TriggerSendDMA()
|
|---|
| | | {
|
|---|
| | | if (!Uart1Stat.Sending&&!IsEmpty(&Uart1Stat.QTx))
|
|---|
| | | if (!Uart1Stat.bSending&&!IsEmpty(&Uart1Stat.QTx))
|
|---|
| | | {
|
|---|
| | | int len1=GetContinueData(&Uart1Stat.QTx);
|
|---|
| | | Uart1SendDMA(GetReadBuffer(&Uart1Stat.QTx),len1);
|
|---|
| | |
|---|
| | | LL_DMA_SetDataLength(DMA1,LL_DMA_CHANNEL_5,nSize);
|
|---|
| | | LL_DMA_EnableChannel(DMA1,LL_DMA_CHANNEL_5);
|
|---|
| | | Uart2Stat.DMARecvLen=nSize;
|
|---|
| | | Uart2Stat.Recving=1; |
|---|
| | | Uart2Stat.bRecving=1; |
|---|
| | | LL_DMA_EnableIT_TC(DMA1,LL_DMA_CHANNEL_5);
|
|---|
| | | LL_USART_EnableDMAReq_RX(USART2);
|
|---|
| | | return 0;
|
|---|
| | |
|---|
| | | LL_DMA_SetDataLength(DMA1,LL_DMA_CHANNEL_4,nSize);
|
|---|
| | | LL_DMA_EnableChannel(DMA1,LL_DMA_CHANNEL_4);
|
|---|
| | | Uart2Stat.DMASendLen=nSize;
|
|---|
| | | Uart2Stat.Sending=1; |
|---|
| | | Uart2Stat.bSending=1; |
|---|
| | | LL_DMA_EnableIT_TC(DMA1,LL_DMA_CHANNEL_4);
|
|---|
| | | LL_USART_EnableDMAReq_TX(USART2);
|
|---|
| | | return nSize;
|
|---|
| | | }
|
|---|
| | | int Uart2TriggerSendDMA()
|
|---|
| | | {
|
|---|
| | | if (!Uart2Stat.Sending&&!IsEmpty(&Uart2Stat.QTx))
|
|---|
| | | if (!Uart2Stat.bSending&&!IsEmpty(&Uart2Stat.QTx))
|
|---|
| | | {
|
|---|
| | | int len1=GetContinueData(&Uart2Stat.QTx);
|
|---|
| | | Uart2SendDMA(GetReadBuffer(&Uart2Stat.QTx),len1);
|
|---|
| | |
|---|
| | |
|
|---|
| | | void PendSvCallBack()
|
|---|
| | | {
|
|---|
| | | #if (BOARD_TYPE == 14)
|
|---|
| | | ///* |
|---|
| | | if (bSPI1RecvDone)
|
|---|
| | | {
|
|---|
| | | bSPI1RecvDone=0;
|
|---|
| | | ParseFP0Pkg(SPI1RecvBuf,nSPI1RecvLenInBuf);
|
|---|
| | | }
|
|---|
| | | //*/ |
|---|
| | | #endif |
|---|
| | | if (Uart2Stat.bPacketRecved)
|
|---|
| | | {
|
|---|
| | | ParsePacket((pPacket)Uart2RecvBuf1,Uart2RecvBuf1DataLen); |
|---|
| | | KBusParsePacket(2, (pKBPacket)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.WDD[62]++;
|
|---|
| | | KMem.WDT[122]++;
|
|---|
| | | if (!bSPI1Sending)
|
|---|
| | | {
|
|---|
| | | logData(value);
|
|---|
| | | }
|
|---|
| | | if (!bSPI1Sending && (1 || bSPI1Recving))
|
|---|
| | | {
|
|---|
| | | SPI1RecvBuf[nSPI1RecvPos]=value;
|
|---|
| | | nSPI1RecvPos++;
|
|---|
| | | |
|---|
| | | if (value==0x0d)
|
|---|
| | | {
|
|---|
| | | logData(nSPI1RecvPos);
|
|---|
| | |
|
|---|
| | | 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);
|
|---|
| | | logData(value);
|
|---|
| | | }
|
|---|
| | | }
|
|---|
| | | #endif |
|---|
| | | } |
|---|
| | | }
|
|---|
| | |
|
|---|
| | | void Uart1SendDone()
|
|---|
| | | {
|
|---|
| | | Uart1Stat.TcCount++;
|
|---|
| | |
|---|
| | | Uart2Stat.IdelCount++;
|
|---|
| | | if (Uart2RecvBuf1DataLen>0)
|
|---|
| | | TriggerPendSV();
|
|---|
| | | // ParsePacket((pPacket)Uart2RecvBuf1,Uart2RecvBuf1DataLen);
|
|---|
| | | // ParsePacket((pKBPacket)Uart2RecvBuf1,Uart2RecvBuf1DataLen);
|
|---|
| | | }
|
|---|
| | |
|
|---|
| | | 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)
|
|---|
| | |
|---|
| | | 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);
|
|---|
| | |
|---|
| | | Uart1Stat.SentPacket++;
|
|---|
| | | return len1;
|
|---|
| | | }
|
|---|
| | | int SendPacket2(pPacket p1,int len1)
|
|---|
| | | int SendPacket2(pKBPacket p1,int len1)
|
|---|
| | | {
|
|---|
| | | PutStr2((char *)p1,len1);
|
|---|
| | | // PushIn(&Uart2Stat.QTx,p1,len1);
|
|---|
| | |
|---|
| | | Uart2Stat.SentPacket++;
|
|---|
| | | return len1;
|
|---|
| | | }
|
|---|
| | |
|
|---|
| | | */
|
|---|
| | | void ToggleRunLed() { LL_GPIO_TogglePin(GPIOC,LL_GPIO_PIN_13);}
|
|---|
| | | void ToggleErrLed() { LL_GPIO_TogglePin(GPIOC,LL_GPIO_PIN_14);}
|
|---|
| | | void ToggleErr2Led() { LL_GPIO_TogglePin(GPIOC,LL_GPIO_PIN_15);}
|
|---|
| | |
|
|---|
| | | #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)
|
|---|
| | |
|---|
| | | if (bOn) {LL_GPIO_SetOutputPin(GPIOA,LL_GPIO_PIN_11);}
|
|---|
| | | else {LL_GPIO_ResetOutputPin(GPIOA,LL_GPIO_PIN_11);}
|
|---|
| | | }
|
|---|
| | | #endif
|
|---|
| | |
|
|---|
| | | void SetRunLed(uchar bOn)
|
|---|
| | | {
|
|---|
| | |
|---|
| | | if (bOn) {LL_GPIO_ResetOutputPin(GPIOC,LL_GPIO_PIN_14);}
|
|---|
| | | else {LL_GPIO_SetOutputPin(GPIOC,LL_GPIO_PIN_14);}
|
|---|
| | | }
|
|---|
| | | void SetErr2Led(uchar bOn)
|
|---|
| | | {
|
|---|
| | | if (bOn) {LL_GPIO_ResetOutputPin(GPIOC,LL_GPIO_PIN_15);}
|
|---|
| | | else {LL_GPIO_SetOutputPin(GPIOC,LL_GPIO_PIN_15);} |
|---|
| | | }
|
|---|
| | | /*
|
|---|
| | | void SetLeds(uchar bRun, uchar bErr)
|
|---|
| | | {
|
|---|
| | | SetRunLed(bRun); SetErrLed (bErr);
|
|---|
| | | }
|
|---|
| | |
|
|---|
| | | */
|
|---|
| | | #define set165SL_0() LL_GPIO_ResetOutputPin(GPIOA,LL_GPIO_PIN_4)
|
|---|
| | | #define set165SL_1() LL_GPIO_SetOutputPin(GPIOA,LL_GPIO_PIN_4)
|
|---|
| | | #define set165CLK_0() LL_GPIO_ResetOutputPin(GPIOA,LL_GPIO_PIN_5)
|
|---|
| | |
|---|
| | | 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);
|
|---|
| | | case 16:
|
|---|
| | | return Input165_R(8);
|
|---|
| | | |
|---|
| | | default:
|
|---|
| | | break;
|
|---|
| | | }
|
|---|
| | |
|---|
| | | 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:
|
|---|
| | | case 16:
|
|---|
| | | return ReadConfig_5(); //Wireless Master Slave 8 in 8 o
|
|---|
| | | default:
|
|---|
| | |
|
|---|
| | | return 0;
|
|---|
| | |
|---|
| | | void Output595_8(unsigned int cc)
|
|---|
| | | {
|
|---|
| | | //unsigned char i;
|
|---|
| | | ;// 74HC595输出程序，输出8位
|
|---|
| | | ;// 74HC595输出程序，输出8位
|
|---|
| | | // cc=~0x3f;
|
|---|
| | | __disable_irq();
|
|---|
| | | STRCLK2_1();
|
|---|
| | |
|---|
| | | STRCLK2_1();
|
|---|
| | | __enable_irq();
|
|---|
| | | }
|
|---|
| | |
|
|---|
| | | void Output595_16(unsigned int cc)
|
|---|
| | | {
|
|---|
| | | //unsigned char i;
|
|---|
| | | ;// 74HC595输出程序，输出8位
|
|---|
| | | ;// 74HC595输出程序，输出8位
|
|---|
| | | // cc=~0x3f;
|
|---|
| | | __disable_irq();
|
|---|
| | | STRCLK2_1();
|
|---|
| | |
|---|
| | | __enable_irq();
|
|---|
| | | }
|
|---|
| | |
|
|---|
| | | /*
|
|---|
| | | #define STRCLK12_0() LL_GPIO_ResetOutputPin(GPIOB,LL_GPIO_PIN_7)
|
|---|
| | | #define STRCLK12_1() LL_GPIO_SetOutputPin(GPIOB,LL_GPIO_PIN_7)
|
|---|
| | |
|
|---|
| | |
|---|
| | | }
|
|---|
| | | KMem.SDD[30]=i;
|
|---|
| | | STRCLK12_0();
|
|---|
| | | STRCLK12_1(); |
|---|
| | | __enable_irq();
|
|---|
| | | __nop();
|
|---|
| | | STRCLK12_1();
|
|---|
| | | __enable_irq();
|
|---|
| | | }
|
|---|
| | |
|
|---|
| | | */
|
|---|
| | |
|
|---|
| | | void PutOutputSPI2(unsigned int Y)
|
|---|
| | | {
|
|---|
| | |
|---|
| | | }
|
|---|
| | | KMem.SDD[30]=i;
|
|---|
| | | STRCLK2_0();
|
|---|
| | | STRCLK2_1(); |
|---|
| | | STRCLK2_1();
|
|---|
| | | __enable_irq();
|
|---|
| | | }
|
|---|
| | |
|
|---|
| | | void PutOutput(unsigned int Y)
|
|---|
| | | {
|
|---|
| | | #if (BOARD_TYPE == 14)
|
|---|
| | | return ;
|
|---|
| | | #else
|
|---|
| | | PutOutputSPI2(Y);
|
|---|
| | | //Output595_16(Y);
|
|---|
| | | #endif
|
|---|
| | | }
|
|---|
| | |
|
|---|
| | | #if (BOARD_TYPE == 9 || BOARD_TYPE == 10 )
|
|---|
| | | #if (BOARD_TYPE == 9 || BOARD_TYPE == 10 || BOARD_TYPE == 15 || BOARD_TYPE == 16)
|
|---|
| | | //#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)
|
|---|
| | |
|---|
| | | #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)
|
|---|
| | |
|---|
| | | 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();
|
|---|
