first and last commit

drivers/hdc/boot/rules.mk

@@ -0,0 +1,19 @@
+# Copyright (C) 2006 Apple Computer, Inc. All rights reserved.
+#
+# This document is the property of Apple Computer, Inc.
+# It is considered confidential and proprietary.
+#
+# This document may not be reproduced or transmitted in any form,
+# in whole or in part, without the express written permission of
+# Apple Computer, Inc.
+#
+LOCAL_DIR := $(GET_LOCAL_DIR)
+
+OPTIONS += \
+	WITH_SW_H2FMI=1
+
+MODULES += \
+	lib/blockdev
+
+ALL_OBJS += \
+	$(LOCAL_DIR)/sw_h2fmi.o

drivers/hdc/boot/sw_h2fmi.c

@@ -0,0 +1,115 @@
+/*
+ * Copyright (C) 2007-2011 Apple Inc. All rights reserved.
+ *
+ * This document is the property of Apple Inc.
+ * It is considered confidential and proprietary.
+ *
+ * This document may not be reproduced or transmitted in any form,
+ * in whole or in part, without the express written permission of
+ * Apple Inc.
+ */
+
+#include "sw_h2fmi_private.h"
+
+#include <debug.h>
+#include <drivers/sw_h2fmi.h>
+#include <lib/blockdev.h>
+#include <sys.h>
+
+static int sw_h2fmi_blockdev_read_block(struct blockdev *bdev, void *ptr, block_addr block, uint32_t count)
+{
+	uint32_t addr_size;
+	int ret = 0;
+	uint32_t page_start, page_end;
+	register uint32_t* dest = (uint32_t*)ptr;
+
+	/* sanity-check the starting block and count */
+	if ((block >= bdev->block_count) || (count > bdev->block_count) || (NULL == ptr))
+		return ret;
+
+	/* adjust the operation length if it overruns */
+	if (block > (bdev->block_count - count))
+		count = bdev->block_count - block;
+
+	addr_size = 4; // Any number  > 0 will do
+	page_start = (block / 3);
+	page_end = ((block + count + 2) / 3);
+
+	/* Reset the device */
+	rFASTSIM_H2FMI_CMD = FASTSIM_H2FMI_RESET;
+
+	for (uint32_t page = page_start; page < page_end; page++) {
+		uint32_t block_addr2, block_addr1, block_addr0;
+		const uint32_t words_per_loop = 8;
+
+		block_addr2 = ((page) >> 16) & 0xFF;
+		block_addr1 = ((page) >> 8) & 0xFF;
+		block_addr0 = ((page) >> 0) & 0xFF;
+
+		/* Send the offset to device */
+		rFASTSIM_H2FMI_ADDR0 = ((block_addr1 << 24) | (block_addr0 << 16));
+		rFASTSIM_H2FMI_ADDR1 = block_addr2;
+		rFASTSIM_H2FMI_ADDRNUM = (addr_size & 0x7);
+
+		/* Roll in the data */
+		for (uint32_t sector = 0; sector < FASTSIM_H2FMI_BLOCK_PER_PAGE; sector++) {
+			register uint32_t index = ((FASTSIM_H2FMI_BLOCK_SIZE / sizeof(uint32_t)) / words_per_loop);
+			do {
+				register uint32_t tmp0;
+				register uint32_t tmp1;
+				register uint32_t tmp2;
+				register uint32_t tmp3;
+				register uint32_t tmp4;
+				register uint32_t tmp5;
+				register uint32_t tmp6;
+				register uint32_t tmp7;
+
+				tmp0 = rFASTSIM_H2FMI_DATA_BUF;
+				tmp1 = rFASTSIM_H2FMI_DATA_BUF;
+				tmp2 = rFASTSIM_H2FMI_DATA_BUF;
+				tmp3 = rFASTSIM_H2FMI_DATA_BUF;
+				tmp4 = rFASTSIM_H2FMI_DATA_BUF;
+				tmp5 = rFASTSIM_H2FMI_DATA_BUF;
+				tmp6 = rFASTSIM_H2FMI_DATA_BUF;
+				tmp7 = rFASTSIM_H2FMI_DATA_BUF;
+
+				if ((((page * 3) + sector) >= block) && (((page * 3) + sector) < (block + count))) {
+					*dest++ = tmp0;
+					*dest++ = tmp1;
+					*dest++ = tmp2;
+					*dest++ = tmp3;
+					*dest++ = tmp4;
+					*dest++ = tmp5;
+					*dest++ = tmp6;
+					*dest++ = tmp7;
+				}
+			} while (--index);
+		}
+	}
+
+	return count;
+}
+
+/* to-do: write and erase */
+
+int sw_h2fmi_init(void)
+{
+	struct blockdev *sw_h2fmi_dev;
+
+	sw_h2fmi_dev = malloc(sizeof(struct blockdev));
+	if (sw_h2fmi_dev == NULL) {
+		dprintf(DEBUG_CRITICAL, "sw_h2fmi_init: failed to create blockdev\n");
+		return -3;
+	}
+	memset(sw_h2fmi_dev, 0, sizeof(struct blockdev));
+
+	/* create the block device */
+	construct_blockdev(sw_h2fmi_dev, "sw-h2fmi", FASTSIM_H2FMI_BLOCK_SIZE * FASTSIM_H2FMI_BLOCK_NUMBER, FASTSIM_H2FMI_BLOCK_SIZE);
+	sw_h2fmi_dev->read_block_hook = &sw_h2fmi_blockdev_read_block;
+
+	/* register it in the block device namespace */
+	register_blockdev(sw_h2fmi_dev);
+
+	return 0;
+}
+

drivers/hdc/boot/sw_h2fmi_private.h

@@ -0,0 +1,29 @@
+/*
+ * Copyright (C) 2007-2011 Apple Inc. All rights reserved.
+ *
+ * This document is the property of Apple Inc.
+ * It is considered confidential and proprietary.
+ *
+ * This document may not be reproduced or transmitted in any form,
+ * in whole or in part, without the express written permission of
+ * Apple Inc.
+ */
+
+#define FASTSIM_H2FMI_BLOCK_PER_PAGE	(3)
+#define FASTSIM_H2FMI_BLOCK_SIZE 	(512)
+#define FASTSIM_H2FMI_BLOCK_NUMBER 	(16384)
+
+/* Register base and offsets address used for FastSim */
+#define FASTSIM_H2FMI_BASE_ADDR		(0x31200000)
+
+#define rFASTSIM_H2FMI_DATA_BUF		(*(volatile u_int32_t *)(FASTSIM_H2FMI_BASE_ADDR + 0x00014))
+#define rFASTSIM_H2FMI_DEBUG0		(*(volatile u_int32_t *)(FASTSIM_H2FMI_BASE_ADDR + 0x0001C))
+#define rFASTSIM_H2FMI_CMD		(*(volatile u_int32_t *)(FASTSIM_H2FMI_BASE_ADDR + 0x40014))
+#define rFASTSIM_H2FMI_ADDR0		(*(volatile u_int32_t *)(FASTSIM_H2FMI_BASE_ADDR + 0x40018))
+#define rFASTSIM_H2FMI_ADDR1		(*(volatile u_int32_t *)(FASTSIM_H2FMI_BASE_ADDR + 0x4001C))
+#define rFASTSIM_H2FMI_ADDRNUM		(*(volatile u_int32_t *)(FASTSIM_H2FMI_BASE_ADDR + 0x40020))
+#define rFASTSIM_H2FMI_STATUS		(*(volatile u_int32_t *)(FASTSIM_H2FMI_BASE_ADDR + 0x40044))
+
+/* CMD */
+#define FASTSIM_H2FMI_RESET	(0xFF)
+