From 9aed5d7e7b3c7bf09da712e9c272ece401a7acc9 Mon Sep 17 00:00:00 2001
From: QuakeGod <QuakeGod@sina.com>
Date: 星期一, 25 十一月 2024 14:51:23 +0800
Subject: [PATCH] add UltraSonic and MultiWireLess
---
KPLC/Src/main.c | 377 ++++++++++++++++++++++++++++++++++++++++++++++++++---
1 files changed, 355 insertions(+), 22 deletions(-)
diff --git a/KPLC/Src/main.c b/KPLC/Src/main.c
index d77ca74..ddb11cc 100644
--- a/KPLC/Src/main.c
+++ b/KPLC/Src/main.c
@@ -51,6 +51,8 @@
#include "string.h"
#include "BSP.h"
#include "ModbusRTU.h"
+#include "spiflash.h"
+
#if (BOARD_TYPE == 13)
#include "w5500_port.h"
#include "../src/Ethernet/socket.h"
@@ -78,6 +80,31 @@
unsigned char Uart2RxBuf[RX2BUFSIZE];
unsigned char Uart2TxBuf[TX2BUFSIZE];
+
+unsigned char Uart1RxBuf1[Uart1RxBufSize];
+unsigned char Uart1TxBuf1[260];
+
+unsigned char Uart2RxBuf1[RX2BUFSIZE];
+unsigned char Uart2TxBuf1[TX2BUFSIZE];
+
+unsigned short Uart1RxBuf1DataLen = 0;
+unsigned short Uart2RxBuf1DataLen = 0;
+
+unsigned char Uart1Mode = 1; //Uart1宸ヤ綔妯″紡锛� 0 : 鏅�氾紝 1 : 閫忎紶妯″紡
+
+unsigned int Uart1Baud = DefaultUart1Baud;
+unsigned int Uart2Baud = DefaultUart2Baud;
+
+//unsigned char Uart1RecvBuf1[Uart1RecvBufSize];
+//unsigned short Uart1RecvBuf1DataLen=0;
+
+//unsigned char Uart2RecvBuf1[128];
+//unsigned short Uart2RecvBuf1DataLen=0;
+
+volatile char Uart1BaudGot=0;
+volatile char Uart1BaudFirstGot=0;
+volatile char Uart1DmaInts=0;
+
unsigned char SlowFlicker=0;
unsigned char FastFlicker=0;
@@ -107,6 +134,183 @@
/* USER CODE END PFP */
/* USER CODE BEGIN 0 */
+#define SET_SCL LL_GPIO_SetOutputPin(GPIOB,LL_GPIO_PIN_6)
+#define CLR_SCL LL_GPIO_ResetOutputPin(GPIOB,LL_GPIO_PIN_6)
+#define GET_SCL LL_GPIO_IsInputPinSet(GPIOB,LL_GPIO_PIN_6)
+#define SET_SDA LL_GPIO_SetOutputPin(GPIOB,LL_GPIO_PIN_7)
+#define CLR_SDA LL_GPIO_ResetOutputPin(GPIOB,LL_GPIO_PIN_7)
+#define GET_SDA LL_GPIO_IsInputPinSet(GPIOB,LL_GPIO_PIN_7)
+
+
+void soft_i2c_start()
+{
+ SET_SDA;
+ SET_SCL;
+ Delay100nS(1);
+ CLR_SDA;
+ Delay100nS(1);
+ CLR_SCL;
+ Delay100nS(1);
+}
+void soft_i2c_stop()
+{
+ CLR_SDA;
+ Delay100nS(1);
+ SET_SCL;
+ Delay100nS(1);
+ SET_SDA;
+ Delay100nS(1);
+}
+void soft_i2c_send8(int nData)
+{
+ int mask;
+ mask = 0x80;
+ for (int j=0;j<8;j++)
+ {
+ if (nData & mask) {SET_SDA;}
+ else {CLR_SDA;}
+ Delay100nS(1);
+ SET_SCL;
+ mask>>=1;
+ Delay100nS(1);
+ CLR_SCL;
+ }
+ return;
+}
+
+uint8_t soft_i2c_recv8()
+{
+ unsigned char nData=0;
+ for (int j=0;j<8;j++)
+ {
+ nData <<=1;
+ Delay100nS(1);
+ SET_SCL;
+ nData |= GET_SDA;
+ Delay100nS(1);
+ CLR_SCL;
+ }
+ return nData;
+}
+
+void soft_i2c_send_ack()
+{
+ CLR_SDA;
+ Delay100nS(2);
+ SET_SCL;
+ Delay100nS(2);
+ CLR_SCL;
+ SET_SDA;
+ Delay100nS(2);
+
+}
+
+void soft_i2c_send_nack()
+{
+ SET_SDA;
+ Delay100nS(1);
+ SET_SCL;
+ Delay100nS(1);
+ CLR_SCL;
+ Delay100nS(1);
+ SET_SDA;
+}
+uint8_t soft_i2c_wait_ack(int nTime)
+{
+ SET_SDA; // Open Drain;
+ Delay100nS(1);
+ SET_SCL;
+ for (int j=0;j<nTime;j++){
+ Delay100nS(1);
+ if (GET_SDA == 0) break;
+ if (j==nTime-1) return 0;
+ }
+ CLR_SCL;
+ return 1;
+}
+uint8_t soft_i2c_check_addr(uint8_t Addr)
+{
+ uint8_t res=0;
+ soft_i2c_start();
+ // Send Device Addr 7bit;
+ soft_i2c_send8(Addr);
+ if (soft_i2c_wait_ack(10)) {res=1;}
+ //Stop
+ soft_i2c_stop();
+// */
+ return res;
+
+}
+uint8_t soft_i2c_read_len( uint8_t Addr , uint8_t Reg, uint8_t len,uint8_t *buf)
+{
+ int res=0;
+ //Start
+ soft_i2c_start();
+ // Send Device Addr 7bit;
+ soft_i2c_send8(Addr &0xfe);
+ // wait Ack;
+ if (!soft_i2c_wait_ack(1000)) {soft_i2c_stop();return 1;}
+ CLR_SCL;
+ // Send Reg Addr 8bit;
+ soft_i2c_send8(Reg);
+ if (!soft_i2c_wait_ack(1000)) {soft_i2c_stop();return 2;}
+ //Start
+ soft_i2c_start();
+ // Send Device Addr 7bit;
+ soft_i2c_send8(Addr | 1);
+ if (!soft_i2c_wait_ack(1000)) {soft_i2c_stop();return 3;}
+
+// /*
+ // Recv Data(s) n * 8bit;
+ SET_SDA; // Open Drain;
+ for (int i=0;i<len;i++)
+ {
+ // recv 1 data 8bit;
+ unsigned char nData = 0;
+ nData = soft_i2c_recv8();
+ buf[i]=nData;
+ // Send ACK / NACK;
+ if (i != len -1) { //ACK
+ soft_i2c_send_ack();
+ } else { // NACK
+ soft_i2c_send_nack();
+ }
+ }
+
+ //Stop
+ soft_i2c_stop();
+// */
+ return res;
+}
+
+uint8_t soft_i2c_write_len(uint8_t Addr , uint8_t Reg, uint8_t len, uint8_t *buf)
+{
+ int res=0;
+ //Start
+ soft_i2c_start();
+ // Send Device Addr 7bit;
+ soft_i2c_send8(Addr &0xfe);
+ // wait Ack;
+ if (!soft_i2c_wait_ack(1000)) return 1;
+ CLR_SCL;
+ // Send Reg Addr 8bit;
+ soft_i2c_send8(Reg);
+ if (!soft_i2c_wait_ack(1000)) return 2;
+ for (int i=0;i<len;i++)
+ {
+ // send 1 data 8bit;
+ unsigned char nData = buf[i];
+ soft_i2c_send8(nData);
+ // wait Ack;
+ if (!soft_i2c_wait_ack(1000)) {res = 5; break;}
+ }
+ //Stop
+ soft_i2c_stop();
+ return res;
+
+}
+
+
int HexToInt(char ch)
{
@@ -148,10 +352,10 @@
#endif
if (Uart2Stat.bPacketRecved)
{
- KBusParsePacket(&KBus1, (pKBPacket)Uart2RecvBuf1, Uart2RecvBuf1DataLen);
- Uart2RecvBuf1DataLen=0;
+ KBusParsePacket(&KBus1, (pKBPacket)Uart2RxBuf1, Uart2RxBuf1DataLen);
+ Uart2RxBuf1DataLen=0;
Uart2Stat.bPacketRecved=0;
- Uart2RecvDMA(Uart2RecvBuf1,sizeof(Uart2RecvBuf1));
+ Uart2RecvDMA(Uart2RxBuf1,sizeof(Uart2RxBuf1));
KMem.WDT[2]++;
}
}
@@ -180,12 +384,22 @@
break;
case KBusEvDataUpdate:
if (KBus1.bMaster) {
- KMem.WLX[0]=KBusMem.WLX[0]; //KPLC with KBus Master
- KBusMem.WLY[0]=KMem.WLY[0];
+ for (int i=0;i<16;i++)
+ {
+ KMem.WLX[i]=KBusMem.WLX[i]; //KPLC with KBus Master
+ KBusMem.WLY[i]=KMem.WLY[i];
+ }
} else if (KBus1.bSlave) {
KMem.WLX[0]=KBusMem.WLY[0]; //KPLC with KBus Slave
KBusMem.WLX[0]=KMem.WLY[0];
+ KMem.WLX[1]=KBusMem.WLY[1]; //KPLC with KBus Slave
+ KBusMem.WLX[1]=KMem.WLY[1];
+ KMem.WLX[2]=KBusMem.WLY[2]; //KPLC with KBus Slave
+ KBusMem.WLX[2]=KMem.WLY[2];
+ KMem.WLX[3]=KBusMem.WLY[3]; //KPLC with KBus Slave
+ KBusMem.WLX[3]=KMem.WLY[3];
}
+
break;
case KBusEvCmdResponse:
break;
@@ -198,6 +412,65 @@
/* USER CODE END 0 */
+/**
+ * @brief This function handles EXTI line 0 and 1 interrupts.
+ */
+void EXTI0_1_IRQHandler(void)
+{
+ /* USER CODE BEGIN EXTI0_1_IRQn 0 */
+
+ /* USER CODE END EXTI0_1_IRQn 0 */
+ if (LL_EXTI_IsActiveFlag_0_31(LL_EXTI_LINE_0) != RESET)
+ {
+ LL_EXTI_ClearFlag_0_31(LL_EXTI_LINE_0);
+ /* USER CODE BEGIN LL_EXTI_LINE_1 */
+
+ unsigned char PowerVolt = LL_GPIO_IsInputPinSet(GPIOA,LL_GPIO_PIN_0);
+// KMem.WDT[79]++;// KMem.WDT[79]++;
+/*
+ if (PowerVolt == 0)
+ {
+ PowerDownFlag=1;
+ }else
+ {
+ PowerDownFlag=0;
+ }
+// */
+ /* USER CODE END LL_EXTI_LINE_1 */
+ }
+ /* USER CODE BEGIN EXTI0_1_IRQn 1 */
+
+ /* USER CODE END EXTI0_1_IRQn 1 */
+}
+
+void EXIT_Init()
+{
+ LL_EXTI_InitTypeDef EXTI_InitStruct = {0};
+
+ /* GPIO Ports Clock Enable */
+ LL_AHB1_GRP1_EnableClock(LL_AHB1_GRP1_PERIPH_GPIOA);
+
+ /**/
+ LL_SYSCFG_SetEXTISource(LL_SYSCFG_EXTI_PORTA, LL_SYSCFG_EXTI_LINE0);
+
+ /**/
+ LL_GPIO_SetPinPull(GPIOA, LL_GPIO_PIN_0, LL_GPIO_PULL_NO);
+
+ /**/
+ LL_GPIO_SetPinMode(GPIOA, LL_GPIO_PIN_0, LL_GPIO_MODE_INPUT);
+
+ /**/
+ EXTI_InitStruct.Line_0_31 = LL_EXTI_LINE_0;
+ EXTI_InitStruct.LineCommand = ENABLE;
+ EXTI_InitStruct.Mode = LL_EXTI_MODE_IT;
+ EXTI_InitStruct.Trigger = LL_EXTI_TRIGGER_RISING_FALLING;
+ LL_EXTI_Init(&EXTI_InitStruct);
+
+ /* EXTI interrupt init*/
+ NVIC_SetPriority(EXTI0_1_IRQn, 0);
+ NVIC_EnableIRQ(EXTI0_1_IRQn);
+
+}
/**
* @brief The application entry point.
@@ -251,7 +524,7 @@
/* Initialize all configured peripherals */
MX_GPIO_Init();
MX_DMA_Init();
-
+// EXIT_Init();
KMachineInit();
ReadSysCfgFromFlash(&storedKMSysCfg);
@@ -306,10 +579,37 @@
Uart1Baud = DefaultUart1Baud;
MX_USART1_UART_Init();
MX_USART2_UART_Init();
-
MX_SPI1_Init();
- LL_SPI_EnableIT_RXNE(SPI1);
+
+/*
+ // MX_I2C1_Init();
+ Soft_I2C1_Init();
+
+ unsigned char buf1[10] = {0x11,0x22,0x33,0x44,0x55,0x66,0x77,0x88,0x99,0xaa};
+ unsigned char buf2[10];
+// KMem.WDB[80] = soft_i2c_read_len(0xa0,0x00,8,buf2);
+// for (int i=0;i<8;i++){
+// buf2[i]+=1;
+// }
+// soft_i2c_write_len (0xa0,0x00,8,buf2);
+// DelayUs(500);
+// KMem.WDB[80] = soft_i2c_read_len(0xa0,0x00,8,&KMem.WDB[81]);
+// DelayUs(500);
+// KMem.WDB[90] = soft_i2c_read_len(0xa0,0x00,8,&KMem.WDB[91]);
+
+ int nPos = 80;
+ int nCount =0;
+ for (int i=0;i<256;i++)
+ {
+ if (soft_i2c_check_addr(i)){
+ KMem.WDB[nPos + 1 + nCount ] = i;
+ nCount+=1;
+ }
+ DelayUs(10);
+ }
+ KMem.WDB[nPos] = nCount;
+*/
#if (BOARD_TYPE == 14)
// MX_SPI2_Init();
// MX_ADC_Init();
@@ -317,7 +617,7 @@
MX_SPI2_Init();
MX_ADC_Init();
#endif
-
+
MX_IWDG_Init();
MX_TIM6_Init();
@@ -329,7 +629,7 @@
LL_USART_EnableIT_TC(USART1);
// LL_USART_EnableIT_RXNE(USART2);
- Uart2RecvDMA(Uart2RecvBuf1,sizeof(Uart2RecvBuf1));
+ Uart2RecvDMA(Uart2RxBuf1,sizeof(Uart2RxBuf1));
LL_USART_EnableIT_IDLE(USART2);
LL_USART_EnableIT_TC(USART2);
#if (BOARD_TYPE == 13)
@@ -350,6 +650,9 @@
// LL_USART_SetAutoBaudRateMode(USART2, LL_USART_AUTOBAUD_DETECT_ON_FALLINGEDGE);
}
//LL_USART_EnableIT_TXE(USART1);
+
+// KMem.WDT[50] = SPI_Flash_ReadID();
+
/* USER CODE END 2 */
@@ -382,7 +685,8 @@
KMRunStat.WorkMode = 1;
//KMRunStat.WorkMode2 = 0;
-
+ W25QXX_Read((uchar *)(&KMem.DT[100]),256,28*2);
+
if (KMRunStat.WorkMode == 1){
InitPLC();
KMRunStat.WorkMode2 = KMem.CurJumperSW&0x20 ;
@@ -396,6 +700,21 @@
KWireLessStart();
#endif
+ LL_GPIO_SetOutputPin(GPIOA,LL_GPIO_PIN_15);
+ KMem.WDT[82]=0;
+
+ W25QXX_Read(&KMem.WDB[160],0,64);
+ KMem.WDT[82]++;
+ KMem.WDT[81]++;
+ W25QXX_Erase_Sector(0);
+ int time1=GetuS();
+// W25QXX_Write_Page(&KMem.WDB[160],0,64);
+// SPI_Flash_Wait_Busy();
+ int time2=GetuS();
+ KMem.WDD[38] =time2-time1;
+// W25QXX_Erase_Sector(0);
+
+ KMem.SDT[64] = SPI_Flash_ReadID();
while (1)
{
//int MyKeyStat1,MyKeyStat2;
@@ -403,6 +722,12 @@
//*((unsigned int *)&(PLCMem.SDT[10]))=nRunCount;
// KMem.nRunCount=nRunCount;
+// LL_GPIO_TogglePin(GPIOB,LL_GPIO_PIN_5);
+// KMem.SDT[64] = SPI_Flash_ReadID();
+// SPI_FLASH_Write_Enable();
+// KMem.SDT[65] = SPI1_Flash_ReadSR();
+
+
SlowFlicker=0;
FastFlicker=1;
us1=GetuS();
@@ -459,25 +784,33 @@
displayInput(KMem.WX[0]);
}
us2=GetuS();
- if (PowerDownEvent) { KMem.WX[0]=0;}
+ if (PowerDownFlag) {KMem.WX[0]=0;}
///*
- if ((KMem.nRunCount &0x1f) == 0x02)
+ if ((KMem.nRunCount &0xf) == 0x02)
{
ADCProcess();
- if (PowerDownEvent)
+ if (PowerDownFlag)
{
KMem.WX[0]=0;
- if (!OldPowerDownEvent)
+ if (!OldPowerDownFlag)
{
- OldPowerDownEvent = PowerDownEvent;
+ OldPowerDownFlag = PowerDownFlag;
OldPowerDownEventTime = nCurTick;
+
+ KMem.WDT[80]++;
+ KMem.WDT[81]++;
+ CLR_SDA;
+ W25QXX_Erase_Sector(0);
+ W25QXX_Write_Page((uchar *)(&KMem.DT[100]),256,28*2);
+ W25QXX_Write_Page(&KMem.WDB[160],0,64);
+ SET_SDA;
PowerDownProcess();
}
}else
{
- if (OldPowerDownEvent)
+ if (OldPowerDownFlag)
{
- OldPowerDownEvent=PowerDownEvent;
+ OldPowerDownFlag=PowerDownFlag;
PowerRecoverProcess();
}
@@ -635,15 +968,15 @@
// memcpy(&KMem.SDT[64+nSize/2],&KBusChnStats[2],nSize);
// for (int i=0;i<128;i++) { SDT[i]=i; }
// SDT[48]=55;
- if (Uart1RecvBuf1DataLen >0 && Uart1Stat.bPacketRecved)
+ if (Uart1RxBuf1DataLen >0 && Uart1Stat.bPacketRecved)
{
int res1 = -1;
- res1 = ModBusSlaveParsePkg(1, Uart1RecvBuf1, Uart1RecvBuf1DataLen);
+ res1 = ModBusSlaveParsePkg(1, Uart1RxBuf1, Uart1RxBuf1DataLen);
if (res1 !=0)
{
- KLParsePacket(1, Uart1RecvBuf1, Uart1RecvBuf1DataLen);
+ KLParsePacket(1, Uart1RxBuf1, Uart1RxBuf1DataLen);
}
- Uart1RecvBuf1DataLen=0;
+ Uart1RxBuf1DataLen=0;
Uart1Stat.bPacketRecved=0;
Uart1IdelTimer = 0;
}else {
--
Gitblit v1.9.1