nes-proj/cpu/msp430/flash.c

110 lines
3.6 KiB
C
Raw Normal View History

/**
* \file
* Functions for reading and writing flash ROM.
* \author Adam Dunkels <adam@sics.se>
*/
/* Copyright (c) 2004 Swedish Institute of Computer Science.
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without modification,
* are permitted provided that the following conditions are met:
*
* 1. Redistributions of source code must retain the above copyright notice,
* this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright notice,
* this list of conditions and the following disclaimer in the documentation
* and/or other materials provided with the distribution.
* 3. The name of the author may not be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT
* SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
* OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
* IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
* OF SUCH DAMAGE.
*
* $Id: flash.c,v 1.1 2006/06/17 22:41:21 adamdunkels Exp $
*
* Author: Adam Dunkels <adam@sics.se>
*
*/
#include <msp430x14x.h>
#include <io.h>
#include <signal.h>
#include "dev/flash.h"
#define FLASH_TIMEOUT 30
#define FLASH_REQ_TIMEOUT 150
static unsigned short ie1, ie2;
/*---------------------------------------------------------------------------*/
void
flash_setup(void)
{
/* Disable all interrupts. */
/* Clear interrupt flag1. */
IFG1 = 0;
/* Stop watchdog. */
WDTCTL = 0x5A80;
/* DCO(SMCLK) is 2,4576MHz, /6 = 409600 Hz
select SMCLK for flash timing, divider 5+1 */
FCTL2 = 0xA5C5;
/* disable all interrupts to protect CPU
during programming from system crash */
_DINT();
/* disable all NMI-Interrupt sources */
ie1 = IE1;
ie2 = IE2;
IE1 = 0x00;
IE2 = 0x00;
}
/*---------------------------------------------------------------------------*/
void
flash_done(void)
{
/* Enable interrupts. */
IE1 = ie1;
IE2 = ie2;
_EINT();
}
/*---------------------------------------------------------------------------*/
void
flash_clear(unsigned short *ptr)
{
FCTL3 = 0xA500; /* Lock = 0 */
while(FCTL3 & 0x0001) nop(); /* Wait for BUSY = 0, not needed
unless run from RAM */
FCTL1 = 0xA502; /* ERASE = 1 */
*ptr = 0; /* erase Flash segment */
FCTL1 = 0xA500; /* ERASE = 0 automatically done?! */
FCTL3 = 0xA510; /* Lock = 1 */
}
/*---------------------------------------------------------------------------*/
void
flash_write(unsigned short *ptr, unsigned short word)
{
FCTL3 = 0xA500; /* Lock = 0 */
while(FCTL3 & 0x0001) nop(); /* Wait for BUSY = 0, not needed unless
run from RAM */
FCTL1 = 0xA540; /* WRT = 1 */
*ptr = word; /* program Flash word */
FCTL1 = 0xA500; /* WRT = 0 */
FCTL3 = 0xA510; /* Lock = 1 */
}
/*---------------------------------------------------------------------------*/