ymodem协议c实现（转）

源：ymodem协议c实现

/****************************************Copyright (c)**************************************************
**                               Henan Star Hi-Tech CO.,LTD
**                                  All rights reserved.
**
**----------------------------------------File Info-----------------------------------------------------
** 文件名称：
** 工程项目：
** 说    明：
**
** 作    者：              日    期：
** 建立版本：
**
**----------------------------------------modification--------------------------------------------------
** 作    者：
** 日    期：
** 版    本：            标    记：
** 说    明：
**
********************************************************************************************************/ 

#ifndef __XYMODEM_H_
#define __XYMODEM_H_ 

#define MODEM_MAX_RETRIES   50      //接收等待延时时间
#define MODEM_CRC_RETRIES   51      //>MODEM_MAX_RETRIES固定为CRC校验
#define MODEM_CAN_COUNT     3       //Wait for 3 times CAN before quiting
#define MODEM_EOT_COUNT     1 

#define MODEM_SOH  0x01        //数据块起始字符
#define MODEM_STX  0x02
#define MODEM_EOT  0x04
#define MODEM_ACK  0x06
#define MODEM_NAK  0x15
#define MODEM_CAN  0x18
#define MODEM_C    0x43 

typedef struct{
    int           modemtype;
    int           crc_mode;
    int           nxt_num;          //下一数据块序号
    int           cur_num;          //当块序号
    int           len;
    int           rec_err;          //数据块接收状态
    unsigned char buf[];        //数据
    unsigned int  filelen;          //Ymodem可有带文件名称和长度
    unsigned char filename[];
}modem_struct; 

#ifdef __cplusplus
    extern "C"{
#endif 

int ymodem_init(modem_struct *mblock);
int modem_recvdata(modem_struct *mblock);
//int crc_16(unsigned char *buf, int len);
void modem_cancle(void);
#ifdef __cplusplus
    }
#endif 

#endif 

/****************************************Copyright (c)**************************************************
**                               Henan Star Hi-Tech CO.,LTD
**                                  All rights reserved.
**
**----------------------------------------File Info-----------------------------------------------------
** 文件名称：
** 工程项目：
** 说    明：
**
** 作    者：              日    期：
** 建立版本：
**
**----------------------------------------modification--------------------------------------------------
** 作    者：
** 日    期：
** 版    本：            标    记：
** 说    明：
**
********************************************************************************************************/   

#include "xymodem1.h"
#include "heads.h"   

unsigned int buf_filelen(unsigned char *ptr);   

/*****************************************************************************************
** 函数名称：
** 函数功能：
** 入口参数：
** 返 回 值：
** 编    写：        日    期：      版 本 号：
** 修改历史：
******************************************************************************************/
int ymodem_init(modem_struct *mblock)
{
    int stat;
    int max_tries = MODEM_MAX_RETRIES;
    int crc_tries =MODEM_CRC_RETRIES;
    unsigned char *bufptr = mblock->buf;
    unsigned char *namptr = mblock->filename;   

    mblock->nxt_num = ;
    mblock->modemtype = ;
    mblock->rec_err = ;
    mblock->crc_mode = ;   

    while (max_tries-- > )
    {
        stat = modem_recvdata(mblock);
        if ( == stat)              //接收成功
        {
            //file name
            while (*bufptr != '\0')
            {
                *namptr++ = *bufptr++;
            }
            *namptr = '\0';
            bufptr++;
            while (*bufptr == ' ')
            {
                bufptr++;
            }
            //file length
            mblock->filelen = buf_filelen(bufptr);
            //other data;
            Uart_SendByte(MODEM_ACK);
            return  ;
        }
        else if ( == stat)         //取消传输
        {
            return ;
        }
        else if (- == stat)
        {
            if (mblock->cur_num == )
            {
                mblock->modemtype = ;
                mblock->nxt_num = ;
                return ;
            }
        }
        else                   //超时或校验方式不对
        {
            if (crc_tries-- <= )
            {
                crc_tries = MODEM_CRC_RETRIES;
                mblock->crc_mode = (mblock->crc_mode+) & ;
            }
        }
    }
    return -;
}   

/*****************************************************************************************
** 函数名称：
** 函数功能：
** 入口参数：
** 返 回 值：0:成功接收数据                 -1:接收超时             -2:帧错误
             -3:帧序号序号错误(严重错误)    1:消息结束              2:取消发送
** 编    写：        日    期：      版 本 号：
** 修改历史：
******************************************************************************************/
int modem_recvdata(modem_struct *mblock)
{
    int stat, hd_found=, i;
    int can_counter=, eot_counter=;
    unsigned char *in_ptr = mblock->buf;
    int cksum;
    unsigned char ch, blk, cblk, crch, crcl;   

    Uart_RxEmpty();                         //接收缓冲区清空   

    if (mblock->nxt_num == )
    {
        if (mblock->crc_mode)
        {
            Uart_SendByte(MODEM_C);
        }
        else
        {
            Uart_SendByte(MODEM_NAK);
        }
    }
    else
    {
        if (mblock->rec_err)
        {
            Uart_SendByte(MODEM_NAK);
        }
        else
        {
            if (mblock->nxt_num == )
            {
                if (mblock->crc_mode)
                {
                    Uart_SendByte(MODEM_C);
                }
                else
                {
                    Uart_SendByte(MODEM_NAK);
                }
            }
            else
            {
                Uart_SendByte(MODEM_ACK);
            }
        }
    }
    while (!hd_found)                               //头字节
    {
        stat = Uart_RecvByteTimeout(&ch);
        if (stat == )
        {
            switch (ch)
            {
                case MODEM_SOH :
                    hd_found = ;
                    mblock->len = ;
                    break;
                case MODEM_STX :
                    hd_found = ;
                    mblock->len = ;
                    break;
                case MODEM_CAN :
                    if ((++can_counter) >= MODEM_CAN_COUNT)
                    {
                        return ;
                    }
                    break;
                case MODEM_EOT :                                //文件传输结束
                    if ((++eot_counter) >= MODEM_EOT_COUNT)
                    {
                        Uart_SendByte(MODEM_ACK);
                        if (mblock->modemtype == )         //Ymodem协议为批文件传输协议
                        {
                            Uart_SendByte(MODEM_C);          //单个文件需 C ACK C后会自动停止传输
                            Uart_SendByte(MODEM_ACK);
                            Uart_SendByte(MODEM_C);
                            modem_cancle();               //多个文件强制停止传输
                        }
                        return ;
                    }
                    break;
                default:
                    break;
            }
        }
        else
        {
            return -;
        }
    }   

    stat = Uart_RecvByteTimeout(&blk);           //数据块错误或超时
    if (stat != )
    {
        return -;
    }   

    stat = Uart_RecvByteTimeout(&cblk);           //数块补码
    if (stat != )
    {
       return -;
    }   

    for (i=; i < mblock->len ; i++)
    {
        stat = Uart_RecvByteTimeout(in_ptr++);
        if (stat != )
        {
            return -;
        }
    }   

    stat = Uart_RecvByteTimeout(&crch);         //CRC
    if (stat != )
    {
        return -;
    }   

    if (mblock->crc_mode)
    {
        stat = Uart_RecvByteTimeout(&crcl);
        if (stat != )
        {
            return -;
        }
    }   

    if (blk^cblk != 0xff)
    {
        return (-);
    }   

    if (mblock->crc_mode)
    {
        in_ptr = mblock->buf;
        cksum = ;   

        for (stat=mblock->len ; stat>; stat--)
        {
            cksum = cksum^(int)(*in_ptr++) << ;
            for (i=; i!=; i--)
            {
                if (cksum & 0x8000)
                    cksum = cksum <<  ^ 0x1021;
                else
                    cksum = cksum << ;
            }
        }
        cksum &= 0xffff;   

        if (cksum != (crch<< | crcl))
        {
            mblock->rec_err = ;
            return (-);
        }
    }
    else
    {
        for (i=; i<mblock->len; i++)                //和校验方式
        {
            cksum += mblock->buf[i];
        }
        if ((cksum&0xff)!=crch)
        {
            mblock->rec_err = ;
            return (-);
        }
    }   

    mblock->cur_num = blk;
    if (blk != mblock->nxt_num)                      //blk检查
    {
        return (-);
    }   

    mblock->nxt_num++;
    mblock->rec_err = ;
    return ;
}   

unsigned int buf_filelen(unsigned char *ptr)
{
    int datatype=, result=;   

    if (ptr[]=='' && (ptr[]=='x' && ptr[]=='X'))
    {
        datatype = ;
        ptr += ;
    }   

    for ( ; *ptr!='\0'; ptr++)
    {
        if (*ptr>= '' && *ptr<='')
        {
            result =result*datatype+*ptr-'';
        }
        else
        {
            if (datatype == )
            {
                return result;
            }
            else
            {
                if (*ptr>='A' && *ptr<='F')
                {
                    result = result* + *ptr-;             //55 = 'A'-10
                }
                else if (*ptr>='a' && *ptr<='f')
                {
                    result = result* + *ptr-;             //87 = 'a'-10
                }
                else
                {
                    return result;
                }
            }
        }
    }
    return result;
}   

void modem_cancle(void)
{
    Uart_SendByte(0x18);
    Uart_SendByte(0x18);
    Uart_SendByte(0x18);
    Uart_SendByte(0x18);
    Uart_SendByte(0x18);
}