Import of the contiki-2.x development code from the SICS internal CVS server

2006-06-17 22:41:10 +00:00 · 2006-06-17 22:41:10 +00:00 · c9e808d638
commit c9e808d638
671 changed files with 95332 additions and 0 deletions
--- a/cpu/msp430/rom.c
+++ b/cpu/msp430/rom.c
@ -0,0 +1,161 @@
+/*
+ * Copyright (c) 2006, 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. Neither the name of the Institute nor the names of its contributors 
+ *    may be used to endorse or promote products derived from this software 
+ *    without specific prior written permission. 
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``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 INSTITUTE OR CONTRIBUTORS 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: rom.c,v 1.1 2006/06/17 22:41:21 adamdunkels Exp $
+ */
+
+#include <io.h>
+
+#include "contiki.h"
+
+#include "dev/rom.h"
+
+struct ictx {
+  int s;
+  unsigned short ie1, ie2, wdtctl;
+};
+
+static void
+mask_intr(struct ictx *c)
+{
+  /* Disable all interrupts. */
+  c->s = splhigh();
+
+#define WDTRPW               0x6900  /* Watchdog key returned by read */
+
+  /* Disable all NMI-Interrupt sources */
+  c->wdtctl = WDTCTL;
+  c->wdtctl ^= (WDTRPW ^ WDTPW);
+  WDTCTL = WDTPW | WDTHOLD;    
+  c->ie1 = IE1;
+  IE1 = 0x00;                  
+  c->ie2 = IE2;
+  IE2 = 0x00;
+
+  /* MSP430F1611 257 < f < 476 kHz, 2.4576MHz/(5+1) = 409.6 kHz. */
+  FCTL2 = FWKEY | FSSEL_SMCLK | (FN2 | FN1);
+  FCTL3 = FWKEY;		/* Unlock flash. */
+}
+
+static void
+rest_intr(struct ictx *c)
+{
+  FCTL1 = FWKEY;		/* Disable erase or write. */
+  FCTL3 = FWKEY | LOCK;		/* Lock flash. */
+  /* Restore interrupts. */
+  IE2 = c->ie2;
+  IE1 = c->ie1;
+  WDTCTL = c->wdtctl;
+  splx(c->s);
+}
+
+/*
+ * This helper routine must reside in RAM!
+ */
+static void
+blkwrt(void *to, const void *from, const void *from_end)
+     // __attribute__ ((section(".data")))
+     ;
+
+int
+rom_erase(long nbytes, off_t offset)
+{
+  int nb = nbytes;
+  char *to = (char *)(uintptr_t)offset;
+  struct ictx c;
+  
+  if(nbytes % ROM_ERASE_UNIT_SIZE != 0) {
+    printf("rom_erase: bad size\n");
+    return -1;
+  }
+
+  if(offset % ROM_ERASE_UNIT_SIZE != 0) {
+    printf("rom_erase: bad offset\n");
+    return -1;
+  }
+
+  while (nbytes > 0) {
+    mask_intr(&c);
+
+    FCTL1 = FWKEY | ERASE;	/* Segment erase. */
+    *to  = 0;			/* Erase segment containing to. */
+    nbytes -= ROM_ERASE_UNIT_SIZE;
+    to += ROM_ERASE_UNIT_SIZE;
+
+    rest_intr(&c);
+  }
+
+  return nb;
+}
+
+int
+rom_pwrite(const void *buf, int nbytes, off_t offset)
+{
+  const char *from = buf;
+  int nb = nbytes;
+  char *to = (char *)(uintptr_t)offset;
+  struct ictx c;
+  
+  mask_intr(&c);
+
+  while(nbytes > 0) {
+    int n = (nbytes > 64) ? 64 : nbytes;
+    FCTL1 = FWKEY | BLKWRT | WRT;	/* Enable block write. */
+    blkwrt(to, from, from + n);
+    while(FCTL3 & BUSY);
+    to += 64;
+    from += 64;
+    nbytes -= n;
+  }
+
+  rest_intr(&c);
+
+  return nb;
+}
+
+/*
+ * This helper routine must reside in RAM!
+ */
+asm(".data");
+asm(".p2align 1,0");
+asm(".type   blkwrt,@function");
+asm(".section        .data");
+
+static void
+blkwrt(void *_to, const void *_from, const void *_from_end)
+{
+  unsigned short *to = _to;
+  const unsigned short *from = _from;
+  const unsigned short *from_end = _from_end;
+  do {
+    *to++ = *from++;
+    while(!(FCTL3 & WAIT));
+  } while(from < from_end);
+  FCTL1 = FWKEY;		/* Disable block write. */
+  /* Now ROM is available again! */
+}