214 lines
5.4 KiB
C
214 lines
5.4 KiB
C
#include "main.h"
|
|
#include "cmsis_os.h"
|
|
#include "lwip.h"
|
|
|
|
/* Private includes ----------------------------------------------------------*/
|
|
/* USER CODE BEGIN Includes */
|
|
#include "string.h"
|
|
#include "stm32h7xx_hal.h"
|
|
#include "stm32h7xx_it.h"
|
|
|
|
#include <lwip/sockets.h>
|
|
#include "lwip/sys.h"
|
|
#include "lwip/api.h"
|
|
|
|
#include "YMODEM/ymodem.h"
|
|
#include "W25QXX/w25qxx.h"
|
|
#include "Param/param.h"
|
|
#include "ADC/adc.h"
|
|
|
|
#include "IAP/iap.h"
|
|
|
|
#define UDP_APP_PORT (6133UL)
|
|
#define LOCAL_PORT (6133UL)
|
|
#define UDP_APP_IP "192.168.8.142"
|
|
|
|
static char gacVersionBuf[32];
|
|
|
|
static struct sockaddr_in udpBroAddr;
|
|
static struct sockaddr_in udpFromAddr;
|
|
static int udp_sockfd = -1;
|
|
|
|
static int sendData(uint8_t *pucData, uint16_t usLen)
|
|
{
|
|
printf("udp send %d bytes\n", usLen);
|
|
|
|
if(udp_sockfd < 0)
|
|
{
|
|
printf("[APP]UDP SEND error , sockfd : %d \r\n",udp_sockfd);
|
|
return -1;
|
|
}
|
|
|
|
struct sockaddr_in addr = udpFromAddr;
|
|
if (udpFromAddr.sin_addr.s_addr == 0) {
|
|
return -1;
|
|
}
|
|
addr.sin_port = htons(LOCAL_PORT);
|
|
if(sendto(udp_sockfd, pucData, usLen, 0, (struct sockaddr *)&addr, sizeof(addr)) != usLen)
|
|
{
|
|
printf("[APP]UDP SEND error \r\n");
|
|
return -1;
|
|
}
|
|
|
|
printf("send ok \r\n");
|
|
|
|
return usLen;
|
|
}
|
|
|
|
void systemReboot(void);
|
|
void adcDataPacketAck(uint32_t ulPid);
|
|
|
|
static void handleCmd(uint8_t *pucBuf, uint16_t usLen)
|
|
{
|
|
if (usLen < 7) {
|
|
return;
|
|
}
|
|
|
|
//dump(pucBuf, usLen);
|
|
|
|
if ((pucBuf[0] == 0xAA) && (pucBuf[1] == 0xCC)) {
|
|
switch (pucBuf[2]) {
|
|
case 0x01: ///< start
|
|
uint16_t ausValue[2];
|
|
memcpy(ausValue, &pucBuf[3], 4);
|
|
|
|
printf("delay : %d, ulSampTime : %d\r\n", ausValue[0], ausValue[1]);
|
|
|
|
if (usLen >=8) {
|
|
adcSampleStart(ausValue[0], ausValue[1], pucBuf[7]);
|
|
} else {
|
|
adcSampleStart(ausValue[0], ausValue[1], 0);
|
|
}
|
|
|
|
break;
|
|
case 0x02: ///< stop
|
|
adcSampleStop();
|
|
printf("[cmd]end ... \r\n");
|
|
break;
|
|
case 0x03: ///< data packet ack
|
|
uint32_t ulPid;
|
|
memcpy(&ulPid, &pucBuf[3], 4);
|
|
|
|
printf("recv ack %u\r\n", ulPid);
|
|
|
|
adcDataPacketAck(ulPid);
|
|
|
|
break;
|
|
case 0x0A: ///< set param
|
|
if (usLen >= sizeof(sysParamDef) + 3) {
|
|
memcpy(gptSysParam, &pucBuf[3], sizeof(sysParamDef));
|
|
saveSysParam();
|
|
adcUpdateParam();
|
|
}
|
|
break;
|
|
case 0x0B: ///< get param
|
|
{
|
|
int i = 0;
|
|
uint8_t aucBuf[sizeof(sysParamDef) + 3];
|
|
|
|
aucBuf[i++] = 0xAA;
|
|
aucBuf[i++] = 0xCC;
|
|
aucBuf[i++] = 0x8B;
|
|
|
|
memcpy(&aucBuf[i], gptSysParam, sizeof(sysParamDef));
|
|
|
|
sendData(aucBuf, sizeof(aucBuf));
|
|
|
|
printf("send param\n");
|
|
}
|
|
break;
|
|
case 0x0C: ///< reboot
|
|
{
|
|
systemReboot();
|
|
}
|
|
break;
|
|
case 0x0D: ///< get version
|
|
{
|
|
int i = 0;
|
|
uint8_t aucBuf[sizeof(gacVersionBuf) + 3];
|
|
|
|
aucBuf[i++] = 0xAA;
|
|
aucBuf[i++] = 0xCC;
|
|
aucBuf[i++] = 0x8D;
|
|
|
|
memcpy(&aucBuf[i], gacVersionBuf, sizeof(gacVersionBuf));
|
|
|
|
sendData(aucBuf, sizeof(aucBuf));
|
|
|
|
printf("send version\n");
|
|
dump(aucBuf, sizeof(aucBuf));
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
int giCmdThreadStatus= 0;
|
|
static void cmdThread(void *arg)
|
|
{
|
|
struct sockaddr_in myaddr;
|
|
static unsigned char recv_buf[1024] = {0};
|
|
int recv_len = 0;
|
|
socklen_t from_len = sizeof(udpFromAddr);
|
|
|
|
udp_sockfd = socket(AF_INET, SOCK_DGRAM ,0);
|
|
if (udp_sockfd < 0) {
|
|
printf("[UDPAPP][ERROR]alloc socket fd failed , again... \r\n");
|
|
while (1) {
|
|
osDelay(100);
|
|
}
|
|
}
|
|
|
|
myaddr.sin_family = AF_INET;
|
|
myaddr.sin_addr.s_addr = INADDR_ANY;
|
|
myaddr.sin_port = htons(UDP_APP_PORT);
|
|
bind(udp_sockfd, (struct sockaddr*)&myaddr, sizeof(myaddr));
|
|
|
|
struct timeval tv = {0, 100 * 1000};
|
|
setsockopt(udp_sockfd, SOL_SOCKET, SO_RCVTIMEO, (char*)&tv, sizeof(tv));
|
|
|
|
memset(&udpBroAddr, 0, sizeof(udpBroAddr));
|
|
udpBroAddr.sin_family = AF_INET;
|
|
udpBroAddr.sin_port = htons(UDP_APP_PORT);
|
|
inet_pton(AF_INET, UDP_APP_IP, &udpBroAddr.sin_addr.s_addr);
|
|
|
|
|
|
while (1) {
|
|
recv_len = recvfrom(udp_sockfd, recv_buf, sizeof(recv_buf), 0, (struct sockaddr *)&udpFromAddr, &from_len);
|
|
giCmdThreadStatus = 0;
|
|
|
|
if (recv_len > 0) {
|
|
debug("[UDPAPP]recv from: %s.%d\r\n", ip4addr_ntoa(&udpFromAddr.sin_addr.s_addr), ntohs(udpFromAddr.sin_port));
|
|
debug("[UDPAPP]len : %d , data buf :",recv_len);
|
|
dump(recv_buf, recv_len);
|
|
debug("");
|
|
|
|
if (recv_len >= 7) {
|
|
debug("[UDPAPP] exec handleUsbCmd");
|
|
handleCmd(recv_buf, recv_len);
|
|
}
|
|
}
|
|
osDelay(20);
|
|
}
|
|
}
|
|
|
|
void cmdInit(void)
|
|
{
|
|
sprintf(gacVersionBuf, "%s@%s_%s", SW_VER, __TIME__, __DATE__);
|
|
// 创建任务
|
|
const osThreadAttr_t cmd_task_attributes = {
|
|
.name = "cmd_task",
|
|
.stack_size = 4096 * 2,
|
|
.priority = (osPriority_t) osPriorityNormal,
|
|
};
|
|
if (osThreadNew(cmdThread, NULL, &cmd_task_attributes) == NULL)
|
|
{
|
|
printf("failed to create cmd_task\n");
|
|
}
|
|
else
|
|
{
|
|
printf("create cmd_task success\n");
|
|
}
|
|
}
|