[U-Boot] [PATCH 04/11] DM: add sata_legacy driver for blockctrl

[Pavel Herrmann <morpheus.ibis@gmail.com>]

This driver works by wrapping the old SATA API to new blockctrl API

Signed-off-by: Pavel Herrmann <morpheus.ibis@gmail.com>
---
 drivers/blockctrl/Makefile      |   1 +
 drivers/blockctrl/sata_legacy.c | 166 ++++++++++++++++++++++++++++++++++++++++
 2 files changed, 167 insertions(+)
 create mode 100644 drivers/blockctrl/sata_legacy.c

diff --git a/drivers/blockctrl/Makefile b/drivers/blockctrl/Makefile
index 21a9094..5df1ce1 100644
--- a/drivers/blockctrl/Makefile
+++ b/drivers/blockctrl/Makefile
@@ -22,6 +22,7 @@ include $(TOPDIR)/config.mk
 LIB	:= $(obj)libblockctrl.o
 
 COBJS-${CONFIG_DM_BLOCK} := core.o
+COBJS-${CONFIG_BLOCK_SATA_LEGACY} += sata_legacy.o
 
 COBJS	:= $(COBJS-y)
 SRCS	:= $(COBJS:.o=.c)
diff --git a/drivers/blockctrl/sata_legacy.c b/drivers/blockctrl/sata_legacy.c
new file mode 100644
index 0000000..9cc41a2
--- /dev/null
+++ b/drivers/blockctrl/sata_legacy.c
@@ -0,0 +1,166 @@
+/*
+ * (C) Copyright 2012
+ * Pavel Herrmann <morpheus.ibis@gmail.com>
+ *
+ * See file CREDITS for list of people who contributed to this
+ * project.
+ *
+ * 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; either version 2 of
+ * the License, or (at your option) any later version.
+ *
+ * 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 <dm/blockctrl.h>
+#include <dm/structures.h>
+#include <dm/manager.h>
+#include <sata.h>
+
+block_dev_desc_t sata_dev_desc[CONFIG_SYS_SATA_MAX_DEVICE];
+
+static lbaint_t read(struct instance *i, int port, lbaint_t start,
+	lbaint_t length, void *buffer)
+{
+	return sata_read(port, start, length, buffer);
+}
+
+static lbaint_t write(struct instance *i, int port, lbaint_t start,
+	lbaint_t length, void *buffer)
+{
+	return sata_write(port, start, length, buffer);
+}
+
+static int scan(struct instance *i, int port)
+{
+	int error;
+
+	error = scan_sata(port);
+	if (error)
+		return error;
+
+	if (!sata_dev_desc[port].lba)
+		return -ENOENT;
+
+	return 0;
+}
+
+static int get_port_count(struct instance *i)
+{
+	return CONFIG_SYS_SATA_MAX_DEVICE;
+}
+
+static int get_port_option(struct instance *i, int port,
+	enum blockctrl_port_option_code op, struct option *result)
+{
+	switch (op) {
+	case BLKP_OPT_IFTYPE:
+		result->flags = OPTION_TYPE_U;
+		result->data.data_u = BLKP_IFTYPE_SATA;
+		return 0;
+	case BLKP_OPT_IFSPEED:
+		result->flags = OPTION_TYPE_U;
+		result->data.data_u = 150;
+		return 0;
+	case BLKP_OPT_BLOCKSIZE:
+		result->flags = OPTION_TYPE_U;
+		result->data.data_u = sata_dev_desc[port].blksz;
+		return 0;
+	case BLKP_OPT_BLOCKCOUNT:
+		result->flags = OPTION_TYPE_U;
+		result->data.data_u = sata_dev_desc[port].lba;
+		return 0;
+	case BLKP_OPT_REMOVABLE:
+		result->flags = OPTION_TYPE_U;
+		result->data.data_u = sata_dev_desc[port].removable;
+		return 0;
+	case BLKP_OPT_LBA48:
+#ifdef CONFIG_LBA48
+		result->flags = OPTION_TYPE_U;
+		result->data.data_u = sata_dev_desc[port].lba48;
+		return 0;
+#else
+		return -EINVAL;
+#endif
+	case BLKP_OPT_VENDOR:
+		result->flags = OPTION_TYPE_S;
+		result->data.data_s = sata_dev_desc[port].vendor;
+		return 0;
+	case BLKP_OPT_PRODUCT:
+		result->flags = OPTION_TYPE_S;
+		result->data.data_s = sata_dev_desc[port].product;
+		return 0;
+	case BLKP_OPT_REVISION:
+		result->flags = OPTION_TYPE_S;
+		result->data.data_s = sata_dev_desc[port].revision;
+		return 0;
+	}
+	return -EINVAL;
+}
+
+static struct blockctrl_ops ops = {
+	.read = read,
+	.write = write,
+	.scan = scan,
+	.get_port_count = get_port_count,
+	.get_port_option = get_port_option,
+};
+
+static int sata_init(void)
+{
+	int rc;
+	int i;
+
+	for (i = 0; i < CONFIG_SYS_SATA_MAX_DEVICE; i++) {
+		memset(&sata_dev_desc[i], 0, sizeof(struct block_dev_desc));
+		sata_dev_desc[i].if_type = IF_TYPE_SATA;
+		sata_dev_desc[i].dev = i;
+		sata_dev_desc[i].part_type = PART_TYPE_UNKNOWN;
+		sata_dev_desc[i].type = DEV_TYPE_HARDDISK;
+		sata_dev_desc[i].lba = 0;
+		sata_dev_desc[i].blksz = 512;
+		sata_dev_desc[i].block_read = sata_read;
+		sata_dev_desc[i].block_write = sata_write;
+
+		rc = init_sata(i);
+		if (!rc)
+			rc = scan_sata(i);
+	}
+	return rc;
+}
+
+static int bind(struct instance *dev)
+{
+	return core_bind(CORE_BLOCKCTRL, dev, &ops, NULL);
+}
+
+static int probe(struct instance *dev)
+{
+	return sata_init();
+}
+
+static int reloc(struct instance *dev, struct instance *old)
+{
+	return core_replace(CORE_BLOCKCTRL, dev, old);
+}
+
+static int remove(struct instance *dev)
+{
+	return 0;
+}
+
+static int unbind(struct instance *dev)
+{
+	return core_unbind(CORE_BLOCKDEV, dev);
+}
+
+U_BOOT_DRIVER(sata_legacy, bind, probe, reloc, remove, unbind);
-- 
1.7.12