diff packages/cygmon/current/misc/bsp/common/generic-mem.c @ 76:435cced73e2f ecos-v1_3_1-release

eCos v1.3.1 merged from eCos master repository on 2000-03-27-23:22:51-BST
author jlarmour
date Tue, 28 Mar 2000 14:10:45 +0000
parents
children e0c0827131d1
line wrap: on
line diff
new file mode 100644
--- /dev/null
+++ b/packages/cygmon/current/misc/bsp/common/generic-mem.c
@@ -0,0 +1,185 @@
+//==========================================================================
+//
+//      generic-mem.c
+//
+//      Generic support for safe memory read/write.
+//
+//==========================================================================
+//####COPYRIGHTBEGIN####
+//                                                                          
+// -------------------------------------------                              
+// The contents of this file are subject to the Red Hat eCos Public License 
+// Version 1.1 (the "License"); you may not use this file except in         
+// compliance with the License.  You may obtain a copy of the License at    
+// http://www.redhat.com/                                                   
+//                                                                          
+// Software distributed under the License is distributed on an "AS IS"      
+// basis, WITHOUT WARRANTY OF ANY KIND, either express or implied.  See the 
+// License for the specific language governing rights and limitations under 
+// the License.                                                             
+//                                                                          
+// The Original Code is eCos - Embedded Configurable Operating System,      
+// released September 30, 1998.                                             
+//                                                                          
+// The Initial Developer of the Original Code is Red Hat.                   
+// Portions created by Red Hat are                                          
+// Copyright (C) 1998, 1999, 2000 Red Hat, Inc.                             
+// All Rights Reserved.                                                     
+// -------------------------------------------                              
+//                                                                          
+//####COPYRIGHTEND####
+//==========================================================================
+//#####DESCRIPTIONBEGIN####
+//
+// Author(s):    
+// Contributors: gthomas
+// Date:         1999-10-20
+// Purpose:      Generic support for safe memory read/write.
+// Description:  Some targets may need to provide their own version.
+//               
+//
+//####DESCRIPTIONEND####
+//
+//=========================================================================
+
+#include <stdlib.h>
+#include <setjmp.h>
+#include <bsp/bsp.h>
+
+typedef void (*moveproc_t)(void *s, void *d);
+
+static jmp_buf __errjmp;
+
+/*
+ * These are globals because we want them preserved
+ * across function calls.
+ */
+static bsp_handler_t __oldtrap;
+static int __done;
+
+
+static void
+move_8(void *src, void *dest)
+{
+    *(char *)dest = *(char *)src;
+}
+
+
+static void
+move_16(void *src, void *dest)
+{
+    *(short *)dest = *(short *)src;
+}
+
+
+static void
+move_32(void *src, void *dest)
+{
+    *(int *)dest = *(int *)src;
+}
+
+
+static int
+err_trap(int exc_nr, void *regs)
+{
+    longjmp(__errjmp, 1);
+}
+
+
+int
+bsp_memory_read(void *addr,    /* start addr of memory to read */
+		int  asid,     /* address space id */
+		int  rsize,    /* size of individual read operation */
+		int  nreads,   /* number of read operations */
+		void *buf)     /* result buffer */
+{
+    if (nreads <= 0)
+	return 0;
+
+    __oldtrap = bsp_install_dbg_handler(err_trap);
+    
+    if (setjmp(__errjmp) == 0) {
+	moveproc_t move_mem;
+	int        incr;
+	char       *src, *dest;
+
+	switch (rsize) {
+	  case 8:
+	    move_mem = move_8;
+	    incr = 1;
+	    break;
+	  case 16:
+	    move_mem = move_16;
+	    incr = 2;
+	    break;
+	  case 32:
+	    move_mem = move_32;
+	    incr = 4;
+	    break;
+	  default:
+	    (void)bsp_install_dbg_handler(__oldtrap);
+	    return 0;
+	}
+
+	src = addr;
+	dest = buf;
+
+	for (__done = 0; __done < nreads; __done++) {
+	    move_mem(src, dest);
+	    src  += incr;
+	    dest += incr;
+	}
+    }
+
+    (void)bsp_install_dbg_handler(__oldtrap);
+    return __done;
+}
+
+
+int bsp_memory_write(void *addr,   /* start addr of memory to write */
+                     int  asid,    /* address space id */
+                     int  wsize,   /* size of individual write operation */
+                     int  nwrites, /* number of write operations */
+                     void *buf)    /* source buffer for write data */
+{
+    if (nwrites <= 0)
+	return 0;
+
+    __oldtrap = bsp_install_dbg_handler(err_trap);
+    
+    if (setjmp(__errjmp) == 0) {
+	moveproc_t move_mem;
+	int        incr;
+	char       *src, *dest;
+
+	switch (wsize) {
+	  case 8:
+	    move_mem = move_8;
+	    incr = 1;
+	    break;
+	  case 16:
+	    move_mem = move_16;
+	    incr = 2;
+	    break;
+	  case 32:
+	    move_mem = move_32;
+	    incr = 4;
+	    break;
+	  default:
+	    (void)bsp_install_dbg_handler(__oldtrap);
+	    return 0;
+	}
+
+	src = buf;
+	dest = addr;
+
+	for (__done = 0; __done < nwrites; __done++) {
+	    move_mem(src, dest);
+	    src  += incr;
+	    dest += incr;
+	}
+    }
+
+    (void)bsp_install_dbg_handler(__oldtrap);
+    return __done;
+}