altos: Rename 'core' to 'kernel'

core remains a bad name to use -- dirvish skips files (and
directories, it seems) with that name.

Signed-off-by: Keith Packard <keithp@keithp.com>

1 files changed, 186 insertions, 0 deletions

diff --git a/src/kernel/ao_storage.c b/src/kernel/ao_storage.c
new file mode 100644
index 00000000..6eddae7f
--- /dev/null
+++ b/src/kernel/ao_storage.c
@@ -0,0 +1,186 @@
+/*
+ * Copyright © 2011 Keith Packard <keithp@keithp.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; version 2 of the License.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
+ */
+
+#include <ao.h>
+#include <ao_storage.h>
+
+uint8_t
+ao_storage_read(ao_pos_t pos, __xdata void *buf, uint16_t len) __reentrant
+{
+	uint16_t this_len;
+	uint16_t this_off;
+
+	ao_storage_setup();
+	if (pos >= ao_storage_total || pos + len > ao_storage_total)
+		return 0;
+	while (len) {
+
+		/* Compute portion of transfer within
+		 * a single block
+		 */
+		this_off = (uint16_t) pos & (ao_storage_unit - 1);
+		this_len = ao_storage_unit - this_off;
+		if (this_len > len)
+			this_len = len;
+
+		if (!ao_storage_device_read(pos, buf, this_len))
+			return 0;
+
+		/* See how much is left */
+		buf += this_len;
+		len -= this_len;
+		pos += this_len;
+	}
+	return 1;
+}
+
+uint8_t
+ao_storage_write(ao_pos_t pos, __xdata void *buf, uint16_t len) __reentrant
+{
+	uint16_t this_len;
+	uint16_t this_off;
+
+	ao_storage_setup();
+	if (pos >= ao_storage_total || pos + len > ao_storage_total)
+		return 0;
+	while (len) {
+
+		/* Compute portion of transfer within
+		 * a single block
+		 */
+		this_off = (uint16_t) pos & (ao_storage_unit - 1);
+		this_len = ao_storage_unit - this_off;
+		if (this_len > len)
+			this_len = len;
+
+		if (!ao_storage_device_write(pos, buf, this_len))
+			return 0;
+
+		/* See how much is left */
+		buf += this_len;
+		len -= this_len;
+		pos += this_len;
+	}
+	return 1;
+}
+
+static __xdata uint8_t storage_data[8];
+
+static void
+ao_storage_dump(void) __reentrant
+{
+	uint8_t i, j;
+
+	ao_cmd_hex();
+	if (ao_cmd_status != ao_cmd_success)
+		return;
+	for (i = 0; ; i += 8) {
+		if (ao_storage_read(((uint32_t) (ao_cmd_lex_i) << 8) + i,
+				  storage_data,
+				  8)) {
+			ao_cmd_put16((uint16_t) i);
+			for (j = 0; j < 8; j++) {
+				putchar(' ');
+				ao_cmd_put8(storage_data[j]);
+			}
+			putchar ('\n');
+		}
+		if (i == 248)
+			break;
+	}
+}
+
+#if HAS_STORAGE_DEBUG
+
+/* not enough space for this today
+ */
+static void
+ao_storage_store(void) __reentrant
+{
+	uint16_t block;
+	uint8_t i;
+	uint16_t len;
+	static __xdata uint8_t b;
+	uint32_t addr;
+
+	ao_cmd_hex();
+	block = ao_cmd_lex_i;
+	ao_cmd_hex();
+	i = ao_cmd_lex_i;
+	addr = ((uint32_t) block << 8) | i;
+	ao_cmd_hex();
+	len = ao_cmd_lex_i;
+	if (ao_cmd_status != ao_cmd_success)
+		return;
+	while (len--) {
+		ao_cmd_hex();
+		if (ao_cmd_status != ao_cmd_success)
+			return;
+		b = ao_cmd_lex_i;
+		ao_storage_write(addr, &b, 1);
+		addr++;
+	}
+}
+#endif
+
+void
+ao_storage_zap(void) __reentrant
+{
+	ao_cmd_hex();
+	if (ao_cmd_status != ao_cmd_success)
+		return;
+	ao_storage_erase((uint32_t) ao_cmd_lex_i << 8);
+}
+
+void
+ao_storage_zapall(void) __reentrant
+{
+	uint32_t	pos;
+
+	ao_cmd_white();
+	if (!ao_match_word("DoIt"))
+		return;
+	for (pos = 0; pos < ao_storage_log_max; pos += ao_storage_block)
+		ao_storage_erase(pos);
+}
+
+void
+ao_storage_info(void) __reentrant
+{
+	ao_storage_setup();
+	printf("Storage size: %ld\n", (long) ao_storage_total);
+	printf("Storage erase unit: %ld\n", (long) ao_storage_block);
+	ao_storage_device_info();
+}
+
+__code struct ao_cmds ao_storage_cmds[] = {
+	{ ao_storage_info, "f\0Show storage" },
+	{ ao_storage_dump, "e <block>\0Dump flash" },
+#if HAS_STORAGE_DEBUG
+	{ ao_storage_store, "w <block> <start> <len> <data> ...\0Write data to flash" },
+#endif
+	{ ao_storage_zap, "z <block>\0Erase <block>" },
+	{ ao_storage_zapall,"Z <key>\0Erase all. <key> is doit with D&I" },
+	{ 0, NULL },
+};
+
+void
+ao_storage_init(void)
+{
+	ao_storage_device_init();
+	ao_cmd_register(&ao_storage_cmds[0]);
+}