/*      $NetBSD: bootxx.c,v 1.11 2014/03/29 05:07:25 ozaki-r Exp $      */

/*-
 * Copyright (c) 1999 Izumi Tsutsui.  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 THE AUTHOR 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.
 */

/*-
 * Copyright (C) 1999 Tsubai Masanari.  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.
 * 3. The name of the author may not be used to endorse or promote products
 *    derived from this software without specific prior written permission.
 *
 * 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 THE AUTHOR 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.
 */

#include <lib/libkern/libkern.h>
#include <lib/libsa/stand.h>
#include <machine/romcall.h>

#include <sys/bootblock.h>

void bootxx(uint32_t, uint32_t, uint32_t, uint32_t);

struct shared_bbinfo bbinfo = {
        { NEWS68K_BBINFO_MAGIC },       /* bbi_magic[] */
        0,                              /* bbi_block_size */
        SHARED_BBINFO_MAXBLOCKS,        /* bbi_block_count */
        { 0 },                          /* bbi_block_table[] */
};

#ifndef DEFAULT_ENTRY_POINT
#define DEFAULT_ENTRY_POINT     0x003e0000
#endif
void (*entry_point)(uint32_t, uint32_t, uint32_t, uint32_t) =
    (void *)DEFAULT_ENTRY_POINT;

#ifdef BOOTXX_DEBUG
# define DPRINTF printf
#else
# define DPRINTF while (0) printf
#endif

char *devs[] = { "hd", "fh", "fd", NULL, NULL, "rd", "st" };

void
bootxx(uint32_t d4, uint32_t d5, uint32_t d6, uint32_t d7)
{
        int fd, blk, bs;
        int ctlr, unit, part, type;
        int i;
        int bootdev = d6;
        char *addr;
        char devname[32];

        printf("NetBSD/news68k Primary Boot\n");

        DPRINTF("\n");
        DPRINTF("d4 %x\n", d4);
        DPRINTF("d5 %x (%s)\n", d5, (char *)d5);
        DPRINTF("d6 %x\n", d6);
        DPRINTF("d7 %x\n", d7);

        DPRINTF("block_size  = %d\n", bbinfo.bbi_block_size);
        DPRINTF("block_count = %d\n", bbinfo.bbi_block_count);
        DPRINTF("entry_point = %p\n", entry_point);

        /* sd(ctlr, lun, part, bus?, host) */

        ctlr = BOOTDEV_CTLR(bootdev);
        unit = BOOTDEV_UNIT(bootdev);
        part = BOOTDEV_PART(bootdev);
        type = BOOTDEV_TYPE(bootdev);

        if (devs[type] == NULL) {
                printf("unknown bootdev (0x%x)\n", bootdev);
                return;
        }

        snprintf(devname, sizeof(devname), "%s(%d,%d,%d)",
            devs[type], ctlr, unit, part);

        fd = rom_open(devname, 0);
        if (fd == -1) {
                printf("cannot open %s\n", devname);
                return;
        }

        addr = (char *)entry_point;
        bs = bbinfo.bbi_block_size;
        DPRINTF("reading block:");
        for (i = 0; i < bbinfo.bbi_block_count; i++) {
                blk = bbinfo.bbi_block_table[i];

                DPRINTF(" %d", blk);

                rom_lseek(fd, blk * 512, 0);
                rom_read(fd, addr, bs);
                addr += bs;
        }
        DPRINTF(" done\n");
        rom_close(fd);

        (*entry_point)(d4, d5, d6, d7);
        DPRINTF("bootxx returned?\n");
}