lynxkdi.c 1.88 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18
/*
 * Copyright (c) Orbacom Systems, Inc <www.orbacom.com>
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms are freely
 * permitted provided that the above copyright notice and this
 * paragraph and the following disclaimer are duplicated in all
 * such forms.
 *
 * This software is provided "AS IS" and without any express or
 * implied warranties, including, without limitation, the implied
 * warranties of merchantability and fitness for a particular
 * purpose.
 */

#include <common.h>
#include <asm/processor.h>
#include <image.h>
19
#include <net.h>
20 21 22

#include <lynxkdi.h>

23 24
DECLARE_GLOBAL_DATA_PTR;

25
#if defined(CONFIG_MPC8260) || defined(CONFIG_440EP) || defined(CONFIG_440GR)
26
void lynxkdi_boot(image_header_t *hdr)
27
{
28
	void (*lynxkdi)(void) = (void(*)(void))image_get_ep(hdr);
29 30
	lynxos_bootparms_t *parms = (lynxos_bootparms_t *)0x0020;
	bd_t *kbd;
31
	u32 *psz = (u32 *)(image_get_load(hdr) + 0x0204);
32

33
	memset(parms, 0, sizeof(*parms));
34 35 36
	kbd = gd->bd;
	parms->clock_ref = kbd->bi_busfreq;
	parms->dramsz = kbd->bi_memsize;
37
	eth_getenv_enetaddr("ethaddr", parms->ethaddr);
38
	mtspr(SPRN_SPRG2, 0x0020);
39 40 41 42

	/* Do a simple check for Bluecat so we can pass the
	 * kernel command line parameters.
	 */
43 44
	/* FIXME: NOT SURE HERE ! */
	if (le32_to_cpu(*psz) == image_get_data_size(hdr)) {
45
		char *args;
46
		char *cmdline = (char *)(image_get_load(hdr) + 0x020c);
47
		int len;
48

49 50 51
		printf("Booting Bluecat KDI ...\n");
		udelay(200*1000); /* Allow serial port to flush */
		if ((args = getenv("bootargs")) == NULL)
52 53
			args = "";
		/* Prepend the cmdline */
54 55 56 57 58
		len = strlen(args);
		if (len && (len + strlen(cmdline) + 2 < (0x0400 - 0x020c))) {
			memmove(cmdline + strlen(args) + 1, cmdline,
				strlen(cmdline));
			strcpy(cmdline, args);
59 60
			cmdline[len] = ' ';
		}
61 62
	}
	else {
63
		printf("Booting LynxOS KDI ...\n");
64 65
	}

66
	lynxkdi();
67 68 69 70
}
#else
#error "Lynx KDI support not implemented for configured CPU"
#endif