初始提交
This commit is contained in:
@@ -0,0 +1,213 @@
|
||||
#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");
|
||||
}
|
||||
}
|
||||
@@ -0,0 +1,12 @@
|
||||
#ifndef CMD_H
|
||||
#define CMD_H
|
||||
|
||||
|
||||
/* Includes ------------------------------------------------------------------*/
|
||||
#include "main.h"
|
||||
/* Exported types ------------------------------------------------------------*/
|
||||
|
||||
|
||||
void cmdInit(void);
|
||||
|
||||
#endif // CMD_H
|
||||
Reference in New Issue
Block a user