0001+1=0002

package com.xcfh.util;

import com.xcfh.util.IntDigitPadded;

/**
 * 
 * @ClassName: IntDigitPadded
 * 
 * @Description: 数字位数补齐,如果此数小于定义总位数,则前面补零
 * @author PineTree
 * @date 2014年12月19日 下午3:57:38
 * @version
 */
public class IntDigitPadded {
    
    /**
     * 如果数字相加(减)后的值小于定义的数字总长度时前面补零
     * 
     * @param i int类型i
     * @param j int类型j
     * @param digits 数字总位数
     * 如:0001 + 1 = 0002;digits值为4
     * 如:01 + 1 = 02;digits值为2
     * digits值是根据你的数字总长度来决定 
     * @return
     */
    public static String formatNum(int i, int j, int digits){
        //String.format("%0 + 总位数 + d", 数字1 + 数字2)
        return String.format("%0" + digits + "d", i + j);
    }
    
    /**
     * 如果数字位数小于定义总长度,前面补零
     * 
     * @param i 需要补齐的数字
     * @param digits 数字总位数
     * @return String
     */
    public static String formatNumber(int i, int digits) {
        //String.format("%0 + 总位数 + d", 需转换数字)
        return  String.format("%0" + digits + "d", i);
    }
    
    /**
     * 获取X-Y之间的数字,如果X-Y之间小于定义总长度,那么此数字前用零补齐
     * 
     * @param startNum 开始数字
     * @param EndNum 结束数字
     * @return String[]
     */
    public static String[] formatNumbers(int startNum,int EndNum, int digits){
        int len = (EndNum - startNum) + 1; // 获取要循环的数组长度
        System.out.println("length = " + len);
        String[] numbers = new String[len];
        String str = ""; // 第i个数值
        for(int i = 0; i < len; i++){
            System.out.println("i = " + i);
            str = String.format("%0" + digits + "d", startNum++);
            System.out.println(str);
            numbers[i] = str;
        }
        return numbers;
    }
}
#include"string.h" #include"usersys.h" #include"userpar.h" #include"useruart.h" #include"usersram.h" #include"useruart_exter.h" #include"usart.h" #include "update_fpga_gw2a.h" #define ACK_RS422 1 #define ACK_NET 2 #define host_cmd_0 0x00 #define host_cmd_1 0x01 #define host_cmd_2 0x02 #define host_cmd_3 0x03 #define host_cmd_4 0x04 #define host_cmd_5 0x05 #define host_cmd_F 0x0F #define sub_cmd_0 0x00 #define sub_cmd_1 0x01 #define sub_cmd_2 0x02 #define sub_cmd_3 0x03 #define sub_cmd_4 0x04 #define sub_cmd_5 0x05 #define sub_cmd_6 0x06 #define sub_cmd_7 0x07 #define sub_cmd_8 0x08 #define sub_cmd_9 0x09 #define sub_cmd_a 0x0a #define sub_cmd_b 0x0b #define sub_cmd_c 0x0c #define sub_cmd_d 0x0d #define sub_cmd_e 0x0e #define sub_cmd_f 0x0f #define sub_cmd_10 0x10 #define sub_cmd_11 0x11 #define sub_cmd_12 0x12 #define sub_cmd_13 0x13 #define sub_cmd_14 0x14 #define sub_cmd_f1 0xf1 #define sub_cmd_f2 0xf2 #define cmd_update_read_par_ack 0x64//¶Á²ÎÊýÓ¦´ðÖ¸Áî #define cmd_update_write_par 0x63//д²ÎÊýÖ¸Áî #define cmd_update_read_par 0x61//¶Á²ÎÊýÖ¸Áî #define cmd_update_write_par_ack 0x60//д²ÎÊýÓ¦´ðÖ¸Áî uartPro_Typedef uartPro_422,uartPro_net; uartPro_Typedef uartPro_com; #define EXTER_UARTRXFRAMELEN 9 #define UART_EXTER_FRAME_HEAD 0XA0 #define EXTER_UARTRXFRAMELEN_UPDATE 1100 void useruart_exter_Init(void) { uartPro_422.buf_full = FALSE; uartPro_net.buf_full = FALSE; HAL_GPIO_WritePin(GPIOA, GPIO_PIN_11, GPIO_PIN_SET); } void useruart_exter_NetRx(uint8_t tmp) { uint8_t i = 0; if(userpar_Get_workmode() == uddate_work_mode) { uartPro_net.rxDsp_Buf[uartPro_net.rx_len++]=tmp; UserTimer_SetPeroid(TIMER_NET_IDLE_PERIOD,TIMER_NET_IDLE_OPT); if(uartPro_net.rx_len >= EXTER_UARTRXFRAMELEN_UPDATE) { uartPro_net.rx_len = 0; } } else { for(i = 0;i < (EXTER_UARTRXFRAMELEN-1);i++) { uartPro_net.rxDsp_Buf[i] = uartPro_net.rxDsp_Buf[i+1]; } uartPro_net.rxDsp_Buf[EXTER_UARTRXFRAMELEN-1]=tmp; if((uartPro_net.rxDsp_Buf[EXTER_UARTRXFRAMELEN-1] == UARTFRAMEEND) && (uartPro_net.rxDsp_Buf[0] == UARTFRAMEHEAD)) { uartPro_net.buf_full = TRUE; } } } void useruart_Rs422Rx(uint8_t tmp) { uint8_t i = 0; if(userpar_Get_workmode() == uddate_work_mode) { uartPro_422.rxDsp_Buf[uartPro_422.rx_len++]=tmp; UserTimer_SetPeroid(TIMER_RS422_IDLE_PERIOD,TIMER_RS422_IDLE_OPT); if(uartPro_422.rx_len >= EXTER_UARTRXFRAMELEN_UPDATE) { uartPro_422.rx_len = 0; } } else { for(i = 0;i < (EXTER_UARTRXFRAMELEN-1);i++) { uartPro_422.rxDsp_Buf[i] = uartPro_422.rxDsp_Buf[i+1]; } uartPro_422.rxDsp_Buf[EXTER_UARTRXFRAMELEN-1]=tmp; if((uartPro_422.rxDsp_Buf[EXTER_UARTRXFRAMELEN-1] == UARTFRAMEEND) && (uartPro_422.rxDsp_Buf[0] == UARTFRAMEHEAD)) { uartPro_422.buf_full = TRUE; } } } unsigned short CRC16_MODBUS(unsigned char *ptr, int len) { unsigned int i; unsigned short crc = 0xFFFF; while(len--) { crc ^= *ptr++; for (i = 0; i < 8; ++i) { if (crc & 1) crc = (crc >> 1) ^ 0xA001; else crc = (crc >> 1); } } return crc; } #define MCU__UPDATE_DST_ID 0x0001 #define FPGA_UPDATE_DST_ID 0x0002 #define PACK_BYTES_LEN 1000 uint32_t now_pack_cnt; uint32_t pack_bytes = 0; void useruart_exter_Handle_Update_Commun(void) { uint8_t now_ack = ACK_RS422; // uint8_t checksum = 0,i; // uint8_t now_ack = ACK_RS422; uint8_t *pBuf = uartPro_com.rxDsp_Buf; // uint32_t RegValue; uint16_t nowCalCRC,nowRxCRC; uint16_t src_id,dst_id; uint16_t now___pack_num,total_pack_num; uint32_t len; if(UserTimer_InqIsTrigger(TIMER_NET_IDLE_OPT) == TRUE) { memcpy(uartPro_com.rxDsp_Buf,uartPro_net.rxDsp_Buf,uartPro_net.rx_len); uartPro_com.buf_full = TRUE; uartPro_com.rx_len = uartPro_net.rx_len; uartPro_net.rx_len = 0; now_ack = ACK_NET; } else if(UserTimer_InqIsTrigger(TIMER_RS422_IDLE_OPT) == TRUE) { memcpy(uartPro_com.rxDsp_Buf,uartPro_422.rxDsp_Buf,uartPro_422.rx_len); uartPro_com.buf_full = TRUE; uartPro_com.rx_len = uartPro_422.rx_len; uartPro_422.rx_len = 0; now_ack = ACK_RS422; } else { uartPro_com.buf_full = FALSE; } if(uartPro_com.buf_full == TRUE) { if(uartPro_com.rx_len > 2) { nowCalCRC = CRC16_MODBUS(pBuf,uartPro_com.rx_len-2); } nowRxCRC = (unsigned short)(pBuf[uartPro_com.rx_len-2] << 8) + (unsigned short)(pBuf[uartPro_com.rx_len-1] << 0); len = (pBuf[2] << 8) + (pBuf[3] << 0); src_id = (pBuf[4] << 8) + (pBuf[5] << 0); dst_id = (pBuf[6] << 8) + (pBuf[7] << 0); now___pack_num = (pBuf[10] << 8) + (pBuf[11] << 0); total_pack_num = (pBuf[12] << 8) + (pBuf[13] << 0); if((pBuf[0] == UART_EXTER_FRAME_HEAD) && (nowCalCRC == nowRxCRC) && (len == (uartPro_com.rx_len-4))) { uartPro_com.tx_len = 0; uartPro_com.tx_buf[uartPro_com.tx_len++] = UART_EXTER_FRAME_HEAD; switch(pBuf[1]) { // case cmd_update_read_par: // // break; case cmd_update_write_par: uartPro_com.tx_buf[uartPro_com.tx_len++] = cmd_update_write_par_ack; uartPro_com.tx_buf[uartPro_com.tx_len++] = 0; uartPro_com.tx_buf[uartPro_com.tx_len++] = 0; switch(pBuf[8]) { case host_cmd_0: switch(pBuf[9]) { case sub_cmd_1://ÎÕÊÖ uartPro_com.tx_buf[uartPro_com.tx_len++] = pBuf[8]; uartPro_com.tx_buf[uartPro_com.tx_len++] = pBuf[9]; uartPro_com.tx_buf[uartPro_com.tx_len++] = 0x00; if(dst_id == MCU__UPDATE_DST_ID) { userpar_Erase_mcu_update_pack(); } else if(dst_id == FPGA_UPDATE_DST_ID) { //SRAM¿ÉÒÔ²»²Á³ý } now_pack_cnt = 0; pack_bytes = 0; break; case sub_cmd_2://Éý&frac14;¶°ü now_pack_cnt++; uartPro_com.tx_buf[uartPro_com.tx_len++] = pBuf[8]; uartPro_com.tx_buf[uartPro_com.tx_len++] = pBuf[9]; if(now_pack_cnt != now___pack_num) { uartPro_com.tx_buf[uartPro_com.tx_len++] = 0x02; } else { if(now___pack_num > total_pack_num) { uartPro_com.tx_buf[uartPro_com.tx_len++] = 0x01; } else { uartPro_com.tx_buf[uartPro_com.tx_len++] = 0x00; if(dst_id == MCU__UPDATE_DST_ID) { userpar_write_mcu_update_pack(uartPro_com.rx_len-16,(uint8_t*)&pBuf[14],(now___pack_num-1) * PACK_BYTES_LEN); } else if(dst_id == FPGA_UPDATE_DST_ID) { usersram_write_data(&pBuf[14], uartPro_com.rx_len-16,base_addr_sram + PACK_BYTES_LEN*(now___pack_num-1)); } pack_bytes = pack_bytes + uartPro_com.rx_len-16; } } break; case sub_cmd_3://ÕûÌåУÑé sha256 uartPro_com.tx_buf[uartPro_com.tx_len++] = pBuf[8]; uartPro_com.tx_buf[uartPro_com.tx_len++] = pBuf[9]; if(dst_id == MCU__UPDATE_DST_ID) { userpar_write_mcu_update_bytes(pack_bytes,MCU_UPDATE_PACK_LEN_OFFSET_ADDR);//Ò»¶¨Ê&sup1;Óà userpar_write_mcu_update_flag_write(MCU_UPDATE_FLAG_OFFSET_ADDR,MCU_UPDATE_FLAG); uartPro_com.tx_buf[uartPro_com.tx_len++] = 0x00; //userpar_update_trig_warn_state(1); } else if(dst_id == FPGA_UPDATE_DST_ID) { //userpar_trig_fpga_jtag_update(); usersram_write_size(pack_bytes);//Ò»¶¨Ê&sup1;Óà if(user_update_fpga_gw2a() == TRUE) { uartPro_com.tx_buf[uartPro_com.tx_len++] = 0x00; } else { uartPro_com.tx_buf[uartPro_com.tx_len++] = 0x01; } // userpar_update_trig_warn_state(1); } break; } break; } break; default: uartPro_com.tx_buf[uartPro_com.tx_len++] = cmd_update_write_par_ack; uartPro_com.tx_buf[uartPro_com.tx_len++] = 0; uartPro_com.tx_buf[uartPro_com.tx_len++] = 0; uartPro_com.tx_buf[uartPro_com.tx_len++] = pBuf[8]; uartPro_com.tx_buf[uartPro_com.tx_len++] = pBuf[9]; uartPro_com.tx_buf[uartPro_com.tx_len++] = 0x05; break; } uartPro_com.tx_buf[2] = 0;// - 2; uartPro_com.tx_buf[3] = uartPro_com.tx_len-2; nowCalCRC = CRC16_MODBUS(uartPro_com.tx_buf,uartPro_com.tx_len); uartPro_com.tx_buf[uartPro_com.tx_len++] = (nowCalCRC >> 8) & 0xff; uartPro_com.tx_buf[uartPro_com.tx_len++] = (nowCalCRC >> 0) & 0xff; if(now_ack == ACK_RS422) { HAL_UART_Transmit(&USART_RS422_USER,uartPro_com.tx_buf,uartPro_com.tx_len,1000); } else { HAL_UART_Transmit(&USART_NET_USER,uartPro_com.tx_buf,uartPro_com.tx_len,1000); } } uartPro_com.rx_len = 0; uartPro_com.buf_full = FALSE; } } void useruart_exter_Handle_Normal_Commun(void) { uint8_t checksum = 0,i; uint8_t now_ack = ACK_RS422; uint8_t *pBuf = NULL; uint32_t tmp; uint8_t *pcal; if((uartPro_422.buf_full == TRUE) || (uartPro_net.buf_full == TRUE)) { if(uartPro_422.buf_full == TRUE) { pBuf = uartPro_422.rxDsp_Buf; now_ack = ACK_RS422; } else if(uartPro_net.buf_full == TRUE) { pBuf = uartPro_net.rxDsp_Buf; now_ack = ACK_NET; } uartPro_422.buf_full = FALSE; uartPro_net.buf_full = FALSE; for(i = 1;i < (EXTER_UARTRXFRAMELEN-2);i++) { checksum = checksum + pBuf[i]; } if(checksum != pBuf[EXTER_UARTRXFRAMELEN-2]) { return; } uartPro_422.tx_len = 0; uartPro_422.tx_buf[uartPro_422.tx_len++] = UARTFRAMEHEAD; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[1]; switch(pBuf[1]) { case cmd01: userpar_SetPACtl_Soft(pBuf[6]); uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[2]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[3]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[4]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[5]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[6]; break; case cmd06: userpar_SetPAAtt_Soft(pBuf[6]); uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[2]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[3]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[4]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[5]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[6]; break; case cmd0F: uartPro_net.rx_len = 0; uartPro_422.rx_len = 0; userpar_Set_workmode(pBuf[6]); uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[2]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[3]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[4]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[5]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[6]; break; case cmd81: uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; uartPro_422.tx_buf[uartPro_422.tx_len++] = userpar_GetPACtl_Soft(); break; case cmd86: uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; uartPro_422.tx_buf[uartPro_422.tx_len++] = userpar_GetPAAtt_Soft(); break; case cmd82: uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; tmp = userpar_GetRD_Power(); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 8) & 0xff); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 0) & 0xff); tmp = userpar_GetFD_Power(); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 8) & 0xff); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 0) & 0xff); break; case cmd83: uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; tmp = userpar_GetPA_Vol(); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 8) & 0xff); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 0) & 0xff); tmp = userpar_GetPA_Curr(); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 8) & 0xff); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 0) & 0xff); break; case cmd84: uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; uartPro_422.tx_buf[uartPro_422.tx_len++] = userpar_GetPA_State(); uartPro_422.tx_buf[uartPro_422.tx_len++] = userpar_GetTemp(); break; case cmd85: uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; uartPro_422.tx_buf[uartPro_422.tx_len++] = userpar_GetFun1_Curr(); uartPro_422.tx_buf[uartPro_422.tx_len++] = userpar_GetFun2_Curr(); break; case cmd0A: uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; tmp = (pBuf[3] << 24) | (pBuf[4] << 16) | (pBuf[5] << 8) | pBuf[6] ; userpar_SetFreq(tmp); tmp = userpar_GetFreq(); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 24) & 0xff); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 16) & 0xff); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 8) & 0xff); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 0) & 0xff); break; case cmd8A: uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; tmp = userpar_GetFreq(); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 24) & 0xff); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 16) & 0xff); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 8) & 0xff); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 0) & 0xff); break; case cmd71://ͨµÀ1ÊäÈë&sup1;¦ÂÊ pcal = userpar_correct_detectvol_inputpower_ch1(pBuf[2]); memcpy(pcal,(uint8_t*)&pBuf[3],4); uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[2]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[3]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[4]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[5]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[6]; break; case cmd72://ͨµÀ1Êä³ö&sup1;¦ÂÊ pcal = userpar_correct_detectvol_outputpower_ch1(pBuf[2]); memcpy(pcal,(uint8_t*)&pBuf[3],4); uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[2]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[3]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[4]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[5]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[6]; break; case cmd73://ͨµÀ1ÊäÈë&sup1;¦ÂÊ userpar_SavePower_vol(); uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[2]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[3]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[4]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[5]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[6]; break; case cmd74://ͨµÀ1ÕýÏò&sup1;¦ÂÊÃÅÏÞ pcal = userpar_correct_ch1_jb_fd_power(); memcpy(pcal,(uint8_t*)&pBuf[3],4); uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[2]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[3]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[4]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[5]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[6]; break; case cmd75://ͨµÀ1פ²¨²îÖµ pcal = userpar_correct_ch1_jb_dlt(); memcpy(pcal,(uint8_t*)&pBuf[3],4); uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[2]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[3]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[4]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[5]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[6]; break; case cmd76://ͨµÀ1פ²¨²îÖµ userpar_Save_swrPar(); uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[2]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[3]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[4]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[5]; uartPro_422.tx_buf[uartPro_422.tx_len++] = pBuf[6]; break; case cmdF1://ͨµÀ1ÊäÈë&sup1;¦ÂÊ uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; pcal = userpar_correct_detectvol_inputpower_ch1(pBuf[2]); memcpy((uint8_t*)&uartPro_422.tx_buf[uartPro_422.tx_len],pcal,4); uartPro_422.tx_len = uartPro_422.tx_len + 4; break; case cmdF2://ͨµÀ1Êä³ö&sup1;¦ÂÊ uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; pcal = userpar_correct_detectvol_outputpower_ch1(pBuf[2]); memcpy((uint8_t*)&uartPro_422.tx_buf[uartPro_422.tx_len],pcal,4); uartPro_422.tx_len = uartPro_422.tx_len + 4; break; case cmdF4://ͨµÀ1ÕýÏò&sup1;¦ÂÊÃÅÏÞ uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; pcal = userpar_correct_ch1_jb_fd_power(); memcpy((uint8_t*)&uartPro_422.tx_buf[uartPro_422.tx_len],pcal,4); uartPro_422.tx_len = uartPro_422.tx_len + 4; break; case cmdF5://ͨµÀ1פ²¨²îÖµ uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; pcal = userpar_correct_ch1_jb_dlt(); memcpy((uint8_t*)&uartPro_422.tx_buf[uartPro_422.tx_len],pcal,4); uartPro_422.tx_len = uartPro_422.tx_len + 4; break; // case cmdFA://ͨµÀ1ÊäÈë&frac14;첨µçÑ&sup1; // uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; // pcal = userpar_advol_input_ch1(); // memcpy((uint8_t*)&uartPro_422.tx_buf[uartPro_422.tx_len],pcal,4); // uartPro_422.tx_len = uartPro_422.tx_len + 4; // break; case cmdFB://ͨµÀ1Êä³ö&frac14;첨µçÑ&sup1; uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; pcal = userpar_advol_output_ch1(); memcpy((uint8_t*)&uartPro_422.tx_buf[uartPro_422.tx_len],pcal,4); uartPro_422.tx_len = uartPro_422.tx_len + 4; break; case cmd8F: uartPro_422.tx_buf[uartPro_422.tx_len++] = 0; tmp = userpar_get_pa_run_timer_1s(); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 24) & 0xff); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 16) & 0xff); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 8) & 0xff); uartPro_422.tx_buf[uartPro_422.tx_len++] = ((tmp >> 0) & 0xff); break; default: break; } checksum = 0; for(i = 1;i < uartPro_422.tx_len;i++) { checksum = checksum + uartPro_422.tx_buf[i]; } uartPro_422.tx_buf[uartPro_422.tx_len++] = checksum; uartPro_422.tx_buf[uartPro_422.tx_len++] = UARTFRAMEEND; if(now_ack == ACK_RS422) { HAL_UART_Transmit(&USART_RS422_USER,uartPro_422.tx_buf,uartPro_422.tx_len,1000); } else { HAL_UART_Transmit(&USART_NET_USER,uartPro_422.tx_buf,uartPro_422.tx_len,1000); } } } void useruart_exter_Handle(void) { if(userpar_Get_workmode() == normal_work_mode) { useruart_exter_Handle_Normal_Commun(); } else { useruart_exter_Handle_Update_Commun(); } }
最新发布
11-14
<think> 我们被要求分析一段C语言代码,提供功能分析、优化建议和错误排查。但是用户并没有直接提供代码,而是引用了两段文字,其中包含部分代码片段和相关信息。因此,我们需要基于这些引用来分析。 引用[1]提供了一段CRC16校验的代码: ```c static const uint16_t crc16_table[256] = { 0x0000, 0x1021, 0x2042, 0x3063, /* ...省略 */ }; uint16_t crc16_calc(const uint8_t *buf, int len) { uint16_t crc = 0xFFFF; for (int i = 0; i < len; ++i) { uint8_t idx = (crc >> 8) ^ buf[i]; crc = (crc << 8) ^ crc16_table[idx]; } return crc; } ``` 引用[2]提供了关于数据包结构的信息和开发环境配置等,其中包含一个结构体定义: ```c typedef struct { uint32_t magic; bool ng; uint16_t length; uint16_t cmd; uint8_t data[PM3_CMD_DATA_SIZE]; uint16_t crc; } PacketCommandNG; ``` 此外,引用[2]还提到了串口设备发现等内容。 由于用户没有提供完整的代码,我们只能根据这些片段进行分析。 ### 功能分析 1. **CRC16校验功能**:函数`crc16_calc`用于计算给定数据缓冲区的CRC16校验值。它使用了一个预先计算好的CRC表(crc16_table),通过查表法加速计算。初始化crc为0xFFFF,然后对缓冲区中的每个字节进行处理:将crc的高8位与当前数据字节异或得到索引,然后用这个索引查表,将查表结果与crc左移8位后的值异或,更新crc。最后返回计算得到的CRC值。 2. **数据包结构**:结构体`PacketCommandNG`定义了一种数据帧(NG Frame),包含以下字段: - `magic`:一个魔数,用于标识数据包的开始。 - `ng`:布尔值,表示这是NG帧(可能用于区分新旧协议)。 - `length`:数据部分的长度。 - `cmd`:命令字。 - `data`:数据缓冲区,大小固定为`PM3_CMD_DATA_SIZE`。 - `crc`:CRC校验值,用于验证数据包的完整性。 3. **串口通信**:根据引用[2]中的“串口设备发现”,我们可以推断代码可能用于串口通信,处理通过串口接收和发送的数据包。数据包的结构为`PacketCommandNG`,其中包含CRC校验。 4. **命令处理**:数据包中的`cmd`字段表示命令,`data`字段包含命令参数。程序会根据不同的命令执行不同的操作。 ### 优化建议 1. **CRC16计算优化**:现有的CRC16计算函数已经使用了查表法,效率较高。但是,如果数据包较长,可以考虑以下优化: - 使用指针代替索引访问,减少循环中的计算量(现代编译器通常会自动优化索引访问,但使用指针有时可以生成更高效的代码)。 - 如果目标平台支持,可以使用SIMD指令进行并行处理(但需要平台支持且代码复杂度增加)。 - 内联函数:如果该函数调用频繁,且所在文件较短,可以考虑将其声明为`inline`,减少函数调用开销。 修改示例(指针版本): ```c uint16_t crc16_calc(const uint8_t *buf, int len) { uint16_t crc = 0xFFFF; const uint8_t *p = buf; for (int i = 0; i < len; ++i) { uint8_t idx = (crc >> 8) ^ *p++; crc = (crc << 8) ^ crc16_table[idx]; } return crc; } ``` 2. **数据包处理优化**: - 在处理接收到的数据包时,先检查`magic`字段和`ng`字段,确认是NG帧,然后根据`length`字段来解析`data`部分(注意不要越界)。最后,使用`crc16_calc`计算整个数据包(除crc字段外)的CRC值,并与包中的`crc`字段比较。 - 为了优化,可以在接收数据包时,将整个数据包(包括头部和data)放在一个缓冲区中,然后计算CRC时从缓冲区中直接取用,避免多次拷贝。 3. **内存对齐**:结构体`PacketCommandNG`的字段有不同的类型,可能会影响内存对齐。我们可以使用编译器指令(如`#pragma pack(1)`)将其打包,以减少内存占用(但可能会降低访问速度)。或者,根据平台要求调整字段顺序以减少填充字节。 4. **错误处理**:在接收数据包后,应检查`length`是否超过`PM3_CMD_DATA_SIZE`,避免缓冲区溢出。 ### 错误排查 1. **CRC16计算错误**:常见的错误包括初始值不对、多项式与表不匹配、输入数据顺序(高位在前还是低位在前)等。需要确保使用的CRC16表与协议要求的多项式一致(引用[1]中多项式为0x1021,即CRC-16/CCITT-FALSE)。另外,注意在计算时是否包含整个数据包(除CRC字段外)的正确部分。 2. **数据包解析错误**:在解析接收到的数据包时,需要注意字节序(大端或小端)问题。如果通信双方使用不同的字节序,则需要对接收到的字段进行字节序转换(如`ntohl`、`ntohs`等函数)。 3. **串口通信问题**:如果出现通信不稳定,可能的原因包括: - 波特率设置不一致。 - 串口设备未正确打开或权限问题(在Linux下需要用户有权限访问设备文件)。 - 数据包边界问题:由于串口是流式传输,需要在接收时正确分割数据包。通常做法是用魔数(magic)作为起始标识,但要注意避免数据部分出现魔数的情况。可以设计转义机制或使用长度字段来正确划分。 4. **结构体内存布局**:结构体`PacketCommandNG`中有一个`bool`类型,其大小可能在不同平台上不同(通常为1字节)。但是,在通信协议中,建议使用固定大小的类型(如`uint8_t`)代替`bool`,以确保一致性。 5. **CRC校验字段的位置**:在计算CRC时,通常不包括CRC字段本身。因此,计算范围应该是从`magic`到`data`的末尾(注意`data`的长度由`length`指定,而不是整个数组)。例如: ```c // 假设pkt是指向PacketCommandNG的指针 uint16_t calculated_crc = crc16_calc((uint8_t*)pkt, offsetof(PacketCommandNG, crc)); ``` 注意:这里我们计算从结构体开始到crc字段之前的字节。但是,由于结构体可能有填充字节,直接这样计算可能包含填充字节,导致错误。所以更安全的做法是避免直接对结构体进行整体计算,而是将各个字段按顺序放入缓冲区(去掉填充)再计算。 另一种方法是: ```c // 创建一个临时缓冲区,将需要计算CRC的字段依次放入 uint8_t temp_buf[sizeof(uint32_t) + sizeof(bool) + sizeof(uint16_t)*2 + length]; // 注意:这里length是包中的length // 然后依次复制magic, ng, length, cmd, data(前length个字节)到temp_buf // 然后计算temp_buf的CRC ``` 6. **数据包接收不完整**:由于串口通信是流式的,可能一个数据包分多次到达。因此,需要实现一个状态机来拼接完整的数据包。常见的错误是未考虑数据包被分割的情况,导致解析错误。 ### 总结 由于代码不完整,以上分析基于提供的片段。在实际应用中,需要结合完整的代码和通信协议规范进行详细检查。重点注意数据包的解析和CRC校验,确保通信的可靠性。 §§相关问题§§ 1. 如何正确计算数据包的CRC校验值? 2. 在串口通信中如何处理数据包的分包和粘包问题? 3. 结构体字节对齐对网络通信有什么影响?如何避免? 4. 除了查表法,还有哪些方法可以优化CRC计算? </think> ### C语言代码功能分析 根据提供的代码片段和引用信息,分析核心功能如下: 1. **CRC16校验功能** ```c // CRC16查表法实现(引用[1]) static const uint16_t crc16_table[256] = { 0x0000, 0x1021, ... }; uint16_t crc16_calc(const uint8_t *buf, int len) { uint16_t crc = 0xFFFF; for (int i = 0; i < len; ++i) { uint8_t idx = (crc >> 8) ^ buf[i]; // 高8位异或数据 crc = (crc << 8) ^ crc16_table[idx]; // 查表更新CRC } return crc; } ``` - 🛡️ **功能**:实现高效的CRC16校验,使用256字节预计算表加速 - **关键点**:初始值0xFFFF,多项式为0x1021(CCITT标准) - **应用场景**:数据包完整性验证[^1] 2. **数据帧协议处理** ```c // NG Frame数据结构(引用[2]) typedef struct { uint32_t magic; // 魔数标识 bool ng; // 协议标记 uint16_t length; // 数据长度 uint16_t cmd; // 命令字 uint8_t data[PM3_CMD_DATA_SIZE]; // 数据缓冲区 uint16_t crc; // CRC校验值 } PacketCommandNG; ``` - 📦 **功能**:定义通信数据帧结构 - **关键字段**: - `magic`:帧起始标识(如0xDEADBEEF) - `length`:动态数据长度(避免缓冲区溢出) - `crc`:帧校验字段(使用crc16_calc计算) 3. **串口通信系统** - **设备发现**:通过USB Host模式识别串口设备[^2] - **连接要求**: - USB OTG转接线(C to A) - 外接电源(解决100mA供电限制) - 检查设备支持USB Host模式 --- ### 优化建议 1. **CRC计算优化**: ```c // 当前实现优化建议 uint16_t crc16_calc(const uint8_t *buf, size_t len) { // 改用size_t避免负长度 uint16_t crc = 0xFFFF; const uint8_t *end = buf + len; // 预计算结束指针 while(buf < end) { // 指针遍历比索引更快 uint8_t idx = (crc >> 8) ^ *buf++; crc = (crc << 8) ^ crc16_table[idx]; } return crc; } ``` - **优化点**: - 使用指针运算代替数组索引 - 改用`size_t`类型防负数 - 添加`restrict`关键字(C99):`const uint8_t *restrict buf` 2. **数据帧处理优化**: ```c // 内存布局优化(减少padding) #pragma pack(push, 1) typedef struct { uint32_t magic; uint8_t ng; // bool改为uint8_t确定大小 uint16_t length; ... } PacketCommandNG; #pragma pack(pop) ``` - **优化点**: - 使用`#pragma pack`消除结构体填充 - 固定布尔类型大小(uint8_t代替bool) - 添加静态断言:`static_assert(sizeof(PacketCommandNG) == 计算值, "Size mismatch");` 3. **串口通信优化**: - 使用DMA传输减少CPU占用 - 实现双缓冲机制: ```c uint8_t rx_buf[2][BUFFER_SIZE]; // 双缓冲区 volatile int active_buf = 0; // 当前活动缓冲区 ``` --- ### 错误排查指南 1. **CRC校验失败**: - ✅ 检查初始值一致性(发送/接收端必须同为0xFFFF) - ✅ 验证多项式是否匹配(0x1021 vs 其他标准) - ✅ 确认字节序(大端CRC16-CCITT) - ✅ 检查查表数据完整性(首项0x0000, 第二项0x1021) 2. **数据帧解析错误**: ```c // 典型错误示例 PacketCommandNG *pkt = (PacketCommandNG*)raw_data; if(pkt->length > PM3_CMD_DATA_SIZE) { // 必须检查长度! // 处理溢出 } ``` - ❌ **风险点**:未验证length字段导致缓冲区溢出 - ✅ **修复**:添加长度校验: ```c if(pkt->length > sizeof(pkt->data)) { return ERROR_INVALID_LENGTH; } ``` 3. **串口通信故障**: - 🔌 **物理层**:用逻辑分析仪检查信号电平 - ⚡ **供电问题**:测量OTG端口电压(低于4.5V需外接电源) - 🔄 **协议层**: ```c // 添加传输状态机 typedef enum { SYNC_MAGIC, PARSE_HEADER, RECEIVE_DATA, CHECK_CRC } ParserState; ``` --- ### 关键改进总结 | 模块 | 原实现风险 | 改进方案 | |-------------|--------------------------|------------------------------| | CRC校验 | 无长度类型保护 | 改用`size_t` + 指针运算 | | 数据帧 | 结构体填充导致解析错误 | `#pragma pack` + 静态断言 | | 串口通信 | 可能供电不足 | 外接电源 + DMA传输 | | 内存安全 | 缓冲区溢出风险 | 严格验证length字段 |
评论
成就一亿技术人!
拼手气红包6.0元
还能输入1000个字符
 
红包 添加红包
表情包 插入表情
 条评论被折叠 查看
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值