first submission
This commit is contained in:
@@ -0,0 +1,164 @@
|
||||
/********************************** (C) COPYRIGHT *******************************
|
||||
* File Name : ModuleConfig.c
|
||||
* Author : WCH
|
||||
* Version : V1.0.0
|
||||
* Date : 2022/06/10
|
||||
* Description : Module configuration related functions.
|
||||
*********************************************************************************
|
||||
* Copyright (c) 2021 Nanjing Qinheng Microelectronics Co., Ltd.
|
||||
* Attention: This software (modified or not) and binary are used for
|
||||
* microcontroller manufactured by Nanjing Qinheng Microelectronics.
|
||||
*******************************************************************************/
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
#include "ModuleConfig.h"
|
||||
#include "wchnet.h"
|
||||
|
||||
/*********************************************************************
|
||||
* @fn CFG_ERASE
|
||||
*
|
||||
* @brief erase Data-Flash block, minimal block is 256B
|
||||
*
|
||||
* @param Page_Address - the address of the page being erased.
|
||||
* Length - Erased data length
|
||||
*
|
||||
* @return none
|
||||
*/
|
||||
void CFG_ERASE(uint32_t Page_Address, u32 Length) {
|
||||
u32 NbrOfPage, EraseCounter;
|
||||
|
||||
FLASH_Unlock_Fast();
|
||||
NbrOfPage = Length / FLASH_PAGE_SIZE;
|
||||
|
||||
for (EraseCounter = 0; EraseCounter < NbrOfPage; EraseCounter++) {
|
||||
FLASH_ErasePage_Fast( Page_Address + (FLASH_PAGE_SIZE * EraseCounter));
|
||||
}
|
||||
FLASH_Lock_Fast();
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn CFG_WRITE
|
||||
*
|
||||
* @brief write Data-Flash data block
|
||||
*
|
||||
* @param StartAddr - the address of the page being written.
|
||||
* Buffer - data buff
|
||||
* Length - written data length
|
||||
*
|
||||
* @return FLASH_Status
|
||||
*/
|
||||
FLASH_Status CFG_WRITE( u32 StartAddr, u8 *Buffer, u32 Length )
|
||||
{
|
||||
u32 address = StartAddr;
|
||||
u32 *p_buff = (u32 *)Buffer;
|
||||
FLASH_Status FLASHStatus = FLASH_COMPLETE;
|
||||
|
||||
FLASH_Unlock();
|
||||
while((address < (StartAddr + Length)) && (FLASHStatus == FLASH_COMPLETE))
|
||||
{
|
||||
FLASHStatus = FLASH_ProgramWord(address, *p_buff);
|
||||
address += 4;
|
||||
p_buff++;
|
||||
}
|
||||
FLASH_Lock();
|
||||
return FLASHStatus;
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn CFG_READ
|
||||
*
|
||||
* @brief read Data-Flash data block
|
||||
*
|
||||
* @param StartAddr - the address of the page being read.
|
||||
* Buffer - data buff
|
||||
* Length - read data length
|
||||
*
|
||||
* @return none
|
||||
*/
|
||||
void CFG_READ( u32 StartAddr, u8 *Buffer, u32 Length )
|
||||
{
|
||||
u32 address = StartAddr;
|
||||
u32 *p_buff = (u32 *)Buffer;
|
||||
|
||||
while(address < (StartAddr + Length))
|
||||
{
|
||||
*p_buff = (*(u32 *)address);
|
||||
address += 4;
|
||||
p_buff++;
|
||||
}
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
* @fn ParseConfigbuf
|
||||
*
|
||||
* @brief Parse Configuration command
|
||||
*
|
||||
* @param buf - data buff.
|
||||
*
|
||||
* @return opcode
|
||||
*/
|
||||
u8 ParseConfigbuf(u8 *buf)
|
||||
{
|
||||
u16 i;
|
||||
u32 len;
|
||||
pnet_comm net = (pnet_comm)buf;
|
||||
|
||||
i = memcmp(net->flag,NET_MODULE_FLAG,sizeof(NET_MODULE_FLAG));
|
||||
if(i) return 0;
|
||||
switch(net->cmd)
|
||||
{
|
||||
case NET_MODULE_CMD_SEARCH : //search module
|
||||
memcpy(net->id,MACAddr,6);
|
||||
net->cmd = NET_MODULE_ACK_SEARCH ;
|
||||
sprintf((char *)net->dat,"%d.%d.%d.%d",(u16)CFG->src_ip[0],
|
||||
(u16)CFG->src_ip[1],(u16)CFG->src_ip[2],(u16)CFG->src_ip[3]);
|
||||
net->len = strlen((char *)net->dat);
|
||||
sprintf((char*)&net->dat[net->len + 1],"%s",CFG->module_name);
|
||||
net->len += strlen((char*)&net->dat[net->len + 1]) + 1;
|
||||
len = sizeof(net_comm);
|
||||
WCHNET_SocketUdpSendTo(0,buf,&len,brocastIp,brocastPort);
|
||||
printf("CMD_SEARCH********************\n");
|
||||
return 0;
|
||||
|
||||
case NET_MODULE_CMD_SET : //Configure module parameters
|
||||
i = memcmp(net->id,MACAddr,6);
|
||||
if(i) return 0;
|
||||
net->cmd = NET_MODULE_ACK_SET ;
|
||||
net->len = 0;
|
||||
memcpy(Configbuf,net->dat,MODULE_CFG_LEN);
|
||||
CFG->cfg_flag[0]=checkcode1;
|
||||
CFG->cfg_flag[1]=checkcode2;
|
||||
CFG_ERASE(PAGE_WRITE_START_ADDR,FLASH_PAGE_SIZE);
|
||||
CFG_WRITE(PAGE_WRITE_START_ADDR,Configbuf,MODULE_CFG_LEN );
|
||||
len = sizeof(net_comm);
|
||||
WCHNET_SocketUdpSendTo(0,buf,&len,brocastIp,brocastPort);
|
||||
printf("CMD_SET***********************\n");
|
||||
return 1;
|
||||
|
||||
case NET_MODULE_CMD_GET : //Get module configuration
|
||||
i = memcmp(net->id,MACAddr,6);
|
||||
if(i) return 0;
|
||||
net->cmd = NET_MODULE_ACK_GET ;
|
||||
/*When returning the configuration information
|
||||
* to the host computer, remove the last two
|
||||
* bytes of the verification code*/
|
||||
net->len = (MODULE_CFG_LEN-2);
|
||||
memcpy(net->dat,Configbuf,(MODULE_CFG_LEN-2)) ;
|
||||
len = sizeof(net_comm);
|
||||
WCHNET_SocketUdpSendTo(0,buf,&len,brocastIp,brocastPort);
|
||||
printf("CMD_GET***********************\n");
|
||||
return 0;
|
||||
|
||||
case NET_MODULE_CMD_RESET : //reset module
|
||||
i = memcmp(net->id,MACAddr,6);
|
||||
if(i) return 0;
|
||||
CFG_ERASE(PAGE_WRITE_START_ADDR,FLASH_PAGE_SIZE);
|
||||
CFG_WRITE(PAGE_WRITE_START_ADDR,Default_cfg,MODULE_CFG_LEN );
|
||||
net->cmd = NET_MODULE_ACK_RESET ;
|
||||
len = sizeof(net_comm);
|
||||
printf("CMD_RESET*********************\n");
|
||||
return 1;
|
||||
default:
|
||||
return 0 ;
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user