Add support for booting PS3s from disk. This is still a little hackish until

we can find a way to get the information from petitboot or to guess it, so
the current algorithm is:

1. See if ps3disk3p1 (first GPT slice on OtherOS partition) exists, and if
   so try to boot it.
2. Otherwise, netboot.

Submitted by:	glevand <geoffrey.levand at mail dot ru >

1 files changed, 165 insertions, 0 deletions

diff --git a/sys/boot/powerpc/ps3/ps3stor.c b/sys/boot/powerpc/ps3/ps3stor.c
new file mode 100644
index 0000000..667b39c
--- /dev/null
+++ b/sys/boot/powerpc/ps3/ps3stor.c
@@ -0,0 +1,165 @@
+/*-
+ * Copyright (C) 2011 glevand (geoffrey.levand@mail.ru)
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
+ * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
+ * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
+ * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
+ * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
+ * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
+ * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
+ * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
+ * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ *
+ * $FreeBSD$
+ */
+
+#include <stand.h>
+
+#include "bootstrap.h"
+#include "lv1call.h"
+#include "ps3bus.h"
+#include "ps3repo.h"
+#include "ps3stor.h"
+
+int ps3stor_setup(struct ps3_stordev *sd, int type)
+{
+	unsigned int i;
+	int err;
+
+	sd->sd_type = type;
+
+	err = ps3repo_find_bus_by_type(PS3_BUS_TYPE_STOR, &sd->sd_busidx);
+	if (err)
+		goto out;
+
+	err = ps3repo_read_bus_id(sd->sd_busidx, &sd->sd_busid);
+	if (err)
+		goto out;
+
+	err = ps3repo_find_bus_dev_by_type(sd->sd_busidx, type, &sd->sd_devidx);
+	if (err)
+		goto out;
+
+	err = ps3repo_read_bus_dev_id(sd->sd_busidx, sd->sd_devidx, &sd->sd_devid);
+	if (err)
+		goto out;
+
+	err = ps3repo_read_bus_dev_blk_size(sd->sd_busidx, sd->sd_devidx, &sd->sd_blksize);
+	if (err)
+		goto out;
+
+	err = ps3repo_read_bus_dev_nblocks(sd->sd_busidx, sd->sd_devidx, &sd->sd_nblocks);
+	if (err)
+		goto out;
+
+	err = ps3repo_read_bus_dev_nregs(sd->sd_busidx, sd->sd_devidx, &sd->sd_nregs);
+	if (err)
+		goto out;
+
+	for (i = 0; i < sd->sd_nregs; i++) {
+		err = ps3repo_read_bus_dev_reg_id(sd->sd_busidx, sd->sd_devidx, i,
+			&sd->sd_regs[i].sr_id);
+		if (err)
+			goto out;
+
+		err = ps3repo_read_bus_dev_reg_start(sd->sd_busidx, sd->sd_devidx, i,
+			&sd->sd_regs[i].sr_start);
+		if (err)
+			goto out;
+
+		err = ps3repo_read_bus_dev_reg_size(sd->sd_busidx, sd->sd_devidx, i,
+			&sd->sd_regs[i].sr_size);
+		if (err)
+			goto out;
+	}
+
+	if (!sd->sd_nregs) {
+		err = ENODEV;
+		goto out;
+	}
+
+	err = lv1_open_device(sd->sd_busid, sd->sd_devid, 0);
+	if (err)
+		goto out;
+
+	err = lv1_setup_dma(sd->sd_busid, sd->sd_devid, &sd->sd_dmabase);
+	if (err)
+		goto close_dev;
+
+	return 0;
+
+close_dev:
+
+	lv1_close_device(sd->sd_busid, sd->sd_devid);
+
+out:
+
+	return err;
+}
+
+int ps3stor_read_sectors(struct ps3_stordev *sd, int regidx,
+        uint64_t start_sector, uint64_t sector_count, uint64_t flags, char *buf)
+{
+#define MIN(a, b)			((a) <= (b) ? (a) : (b))
+#define BOUNCE_SECTORS			4
+#define ASYNC_STATUS_POLL_PERIOD	100 /* microseconds */
+
+	struct ps3_storreg *reg = &sd->sd_regs[regidx];
+	char dma_buf[sd->sd_blksize * BOUNCE_SECTORS];
+	uint64_t nleft, nread, nsectors;
+	uint64_t tag, status;
+	unsigned int timeout;
+	int err;
+
+	nleft = sector_count;
+	nread = 0;
+
+	while (nleft) {
+		nsectors = MIN(nleft, BOUNCE_SECTORS);
+
+		err = lv1_storage_read(sd->sd_devid, reg->sr_id, start_sector + nread, nsectors,
+			flags, (uint32_t) dma_buf, &tag);
+		if (err)
+			return err;
+
+		timeout = 5000000; /* microseconds */
+
+		while (1) {
+			if (timeout < ASYNC_STATUS_POLL_PERIOD)
+				return ETIMEDOUT;
+
+			err = lv1_storage_check_async_status(sd->sd_devid, tag, &status);
+			if (!err && !status)
+				break;
+
+			delay(ASYNC_STATUS_POLL_PERIOD);
+			timeout -= ASYNC_STATUS_POLL_PERIOD;
+		}
+
+		memcpy(buf + nread * sd->sd_blksize, (u_char *) dma_buf, nsectors * sd->sd_blksize);
+		nread += nsectors;
+		nleft -= nsectors;
+	}
+
+	return 0;
+
+#undef MIN
+#undef BOUNCE_SECTORS
+#undef ASYNC_STATUS_POLL_PERIOD
+}
+
+void ps3stor_print(struct ps3_stordev *sd)
+{
+}