evmlogic.c

来自「在55XDSP下写FLASH的程序」· C语言 代码 · 共 32 行

/*
 *  Copyright (C) 2001, Spectrum Digital, Inc.  All Rights Reserved.
 */
 
#include "5509.h"
#include "util.h"

#define LATCH_ADDR     ((volatile unsigned *)0x401000)

#define FLASH_BASE     0x200000

void Logic_SetPage(unsigned int highaddr)
{
    *LATCH_ADDR = highaddr;
}

unsigned short Logic_ReadFlash(unsigned long addr)
{
    *LATCH_ADDR = (addr >> 12 & 0x00ff);
    *LATCH_ADDR = (addr >> 12 & 0x00ff);
    return *((unsigned short *)(FLASH_BASE + (addr & 0x0fff)));
}

void Logic_WriteFlash(unsigned long addr, unsigned int data)
{
    *LATCH_ADDR = (addr >> 12 & 0x00ff);
    *LATCH_ADDR = (addr >> 12 & 0x00ff);
    *((unsigned short *)(FLASH_BASE + (addr & 0x0fff))) = data;  
}