/****************************************Copyright (c)**************************************************
**                               廣州周立功單片機發展有限公司
**                                     研    究    所
**                                        ARM開發組
**
**                                 http://www.zlgmcu.com
**
**--------------文件信息--------------------------------------------------------------------------------
**文   件   名: flash.c
**創   建   人: 陳明計
**最后修改日期:  2003年9月3日
**描        述: FAT文件系統在PC上編譯的軟盤驅動程序（底層驅動）
**              
**--------------歷史版本信息----------------------------------------------------------------------------
** 創建人: 陳明計
** 版  本: V1.0
** 日　期: 2003年9月3日
** 描　述: 原始版本
**
**--------------當前版本修訂------------------------------------------------------------------------------
** 修改人: 
** 日　期:
** 描　述:
**
**------------------------------------------------------------------------------------------------------
********************************************************************************************************/

#define IN_FLOPPY
#include "config.h"

/*********************************************************************************************************
** 函數名稱: GetAddr
** 功能描述: 轉換地址
** 輸　入: 無
** 輸　出: 無
** 全局變量: 無
** 調用模塊: 無
**
** 作　者: 陳明計
** 日　期: 2004年2月26日
**-------------------------------------------------------------------------------------------------------
** 修改人: 
** 日　期: 
**------------------------------------------------------------------------------------------------------
********************************************************************************************************/
        volatile uint16 *GetAddr(uint16 addr)
{
    uint32 temp;
    
    temp = 0x80000000;
    temp += (addr << 1);
    return (volatile uint16 *)temp;
}
/*********************************************************************************************************
** 函數名稱: WordProgram
** 功能描述: 字編程
** 輸　入: 無
** 輸　出: TRUE:成功
**         FALSE:失敗
** 全局變量: 無
** 調用模塊: GetAddr
**
** 作　者: 陳明計
** 日　期: 2004年2月26日
**-------------------------------------------------------------------------------------------------------
** 修改人: 
** 日　期: 
**------------------------------------------------------------------------------------------------------
********************************************************************************************************/
        uint8 WordProgram(uint32 Addr, uint16 Data) 
{
    volatile uint16 *ip;
    uint16 temp1,temp2;

    ip = GetAddr(0x5555);
    ip[0] = 0xaaaa;
    ip = GetAddr(0x2aaa);
    ip[0] = 0x5555;
    ip = GetAddr(0x5555);
    ip[0] = 0xa0a0;
    
    ip = ((volatile uint16 *)(Addr));
    *ip = Data;
    while (1)
    {
        temp1 = *ip;
        temp2 = *ip;
        if (temp1 == temp2)
        {
            if (temp1 != Data)
            {
                return FALSE;
            }
            else
            {
                return TRUE;
            }
        }
    }
    return TRUE;
}

/*********************************************************************************************************
** 函數名稱: ChipErase
** 功能描述: 芯片擦除
** 輸　入: 無
** 輸　出: TRUE:成功
**         FALSE:失敗
** 全局變量: 無
** 調用模塊: GetAddr
**
** 作　者: 陳明計
** 日　期: 2004年2月26日
**-------------------------------------------------------------------------------------------------------
** 修改人: 
** 日　期: 
**------------------------------------------------------------------------------------------------------
********************************************************************************************************/
        uint8 ChipErase(void) 
{
    volatile uint16 *ip;
    uint16 temp1,temp2;

    ip = GetAddr(0x5555);
    ip[0] = 0xaaaa;
    ip = GetAddr(0x2aaa);
    ip[0] = 0x5555;
    ip = GetAddr(0x5555);
    ip[0] = 0x8080;
    ip = GetAddr(0x5555);
    ip[0] = 0xaaaa;
    ip = GetAddr(0x2aaa);
    ip[0] = 0x5555;
    ip = GetAddr(0x5555);
    ip[0] = 0x1010;

    while (1)
    {
        temp1 = *ip;
        temp2 = *ip;
        if (temp1 == temp2)
        {
            if (temp1 != 0xffff)
            {
                return FALSE;
            }
            else
            {
                return TRUE;
            }
        }
    }
    return TRUE;
}

/*********************************************************************************************************
** 函數名稱: SectorErase
** 功能描述: 扇區擦除擦除
** 輸　入: 無
** 輸　出: TRUE:成功
**         FALSE:失敗
** 全局變量: 無
** 調用模塊: GetAddr
**
** 作　者: 陳明計
** 日　期: 2004年2月26日
**-------------------------------------------------------------------------------------------------------
** 修改人: 
** 日　期: 
**------------------------------------------------------------------------------------------------------
********************************************************************************************************/
        uint8 SectorErase(uint32 Index) 
{
    volatile uint16 *ip;
    uint16 temp1,temp2;

    ip = GetAddr(0x5555);
    ip[0] = 0xaaaa;
    ip = GetAddr(0x2aaa);
    ip[0] = 0x5555;
    ip = GetAddr(0x5555);
    ip[0] = 0x8080;
    ip = GetAddr(0x5555);
    ip[0] = 0xaaaa;
    ip = GetAddr(0x2aaa);
    ip[0] = 0x5555;
    ip = GetAddr(Index << 11);
    ip[0] = 0x3030;

    while (1)
    {
        temp1 = *ip;
        temp2 = *ip;
        if (temp1 == temp2)
        {
            if (temp1 != 0xffff)
            {
                return FALSE;
            }
            else
            {
                return TRUE;
            }
        }
    }
    return TRUE;
}

/*********************************************************************************************************
** 函數名稱: FlashCammand
** 功能描述: 底層驅動程序與上層的接口程序
**
** 輸　入: Cammand：DISK_INIT：驅動程序初始化
**                 DISK_CLOSE：關閉驅動器（移除驅動程序）                 
**                 DISK_CREATE_BOOT_SECTOR：重建引導扇區
**                 DISK_READ_SECTOR：讀扇區
**                 DISK_WRITE_SECTOR：寫扇區
**        Parameter：剩余參數
** 輸　出: DISK_READ_OK：讀扇區完成
**        DISK_READ_NOT_OK：讀扇區失敗
**        DISK_WRITE_OK：寫扇區完成
**        DISK_WRITE_NOT_OK：寫扇區失敗
**        DISK_INIT_OK：初始化完成
**        DISK_INIT_NOT_OK：初始化失敗
**        BAD_DISK_COMMAND：無效的命令
** 全局變量: 無
** 調用模塊: 無
**
** 作　者: 陳明計
** 日　期: 2003年9月3日
**-------------------------------------------------------------------------------------------------------
** 修改人:
** 日　期:
**------------------------------------------------------------------------------------------------------
********************************************************************************************************/
        uint16 FlashCammand(uint8 Cammand, void *Parameter)
{
    uint16 rt;
    Disk_RW_Parameter * Dp;
    Disk_Info *DiskInfo;
    uint16 *ip1, *ip2;
    uint16 i;
    uint32 temp;
    
    Dp = (Disk_RW_Parameter *)Parameter;

    switch (Cammand)
    {
        case DISK_INIT:
            rt = DISK_INIT_NOT_OK;
            DiskInfo = GetEmptyDiskInfoAddr();
            if (DiskInfo != NULL)
            {
                DiskInfo->DiakCommand = FlashCammand;
                rt = DISK_INIT_OK;
            }
            break;
        case DISK_CLOSE:
            rt = RETURN_OK;
            break;
        case DISK_READ_SECTOR:
            rt = DISK_READ_OK;
            ip2 = (uint16 *)Dp->Buf;
            temp = Dp->SectorIndex << 11;
            for (i = 0; i < (1 << 11); i++)
            {
                ip1 = (uint16 *)GetAddr(temp);
                *ip2++ = *ip1;
                temp++;
            }
            break;
        case DISK_WRITE_SECTOR:
            rt = DISK_WRITE_OK;
            ip2 = (uint16 *)Dp->Buf;
            temp = Dp->SectorIndex << 11;
            for (i = 0; i < (1 << 11); i++)
            {
                ip1 = (uint16 *)GetAddr(temp);
                if (*ip2++ != *ip1)
                {
                    break;
                }
                temp++;
            }
            ip2 = (uint16 *)Dp->Buf;
            temp = Dp->SectorIndex << 11;
            if (i < (1 << 11))
            {
                
                for (i = 0; i < (1 << 11); i++)
                {
                    ip1 = (uint16 *)GetAddr(temp);
                    if (*ip1 != 0xffff)
                    {
                        break;
                    }
                }
                if (i < (1 << 11))
                {
                    SectorErase(Dp->SectorIndex);
                }
                for (i = 0; i < (1 << 11); i++)
                {
                    WordProgram(temp, *ip2++);
                    temp++;
                }
            }
            break;
        default:
            rt = BAD_DISK_COMMAND;
            break;
    }
    return rt;
}
/*********************************************************************************************************
**                            End Of File
********************************************************************************************************/