Add qemu 2.4.0
[kvmfornfv.git] / qemu / roms / SLOF / board-js2x / slof / citrine-flash.fs
diff --git a/qemu/roms/SLOF/board-js2x/slof/citrine-flash.fs b/qemu/roms/SLOF/board-js2x/slof/citrine-flash.fs
new file mode 100644 (file)
index 0000000..5842b07
--- /dev/null
@@ -0,0 +1,36 @@
+\ *****************************************************************************
+\ * Copyright (c) 2004, 2008 IBM Corporation
+\ * All rights reserved.
+\ * This program and the accompanying materials
+\ * are made available under the terms of the BSD License
+\ * which accompanies this distribution, and is available at
+\ * http://www.opensource.org/licenses/bsd-license.php
+\ *
+\ * Contributors:
+\ *     IBM Corporation - initial implementation
+\ ****************************************************************************/
+
+
+\ we do all flash accesses as 8-bit
+
+9f000000 CONSTANT citrine-flash-addr
+
+: >citrine-flash  citrine-flash-addr + ;
+: citrine-flash@  >citrine-flash rb@ ;
+: citrine-flash!  >citrine-flash rb! ;
+: wait-for-citrine-flash-ready  BEGIN 0 citrine-flash@ 80 and UNTIL ;
+: erase-citrine-flash-block ( offset -- )
+  cr dup 8 .r ."  Erasing..."
+  20 over citrine-flash! d0 swap citrine-flash! wait-for-citrine-flash-ready ;
+: write-citrine-flash ( data offset -- )
+  over ff = IF 2drop EXIT THEN
+  40 over citrine-flash! citrine-flash! wait-for-citrine-flash-ready ;
+: write-citrine-flash-block ( addr offset -- ) \ always writes 128kB!
+  ."  Writing..."
+  20000 0 DO over i + c@ over i + write-citrine-flash LOOP 2drop
+  ."  Done." ;
+: citrine-flash ( addr offset size -- )
+  BEGIN dup 0 > WHILE >r dup erase-citrine-flash-block
+  2dup write-citrine-flash-block >r 20000 + r> 20000 + r> 20000 - REPEAT
+  drop 2drop -1 0 citrine-flash! ;
+