openwrtv4/target/linux/adm5120-2.6/files/arch/mips/adm5120/board.c

/*
 *  $Id$
 *
 *  ADM5120 generic board code
 *
 *  Copyright (C) 2007 OpenWrt.org
 *  Copyright (C) 2007 Gabor Juhos <juhosg@freemail.hu>
 *
 *  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., 51 Franklin Street, Fifth Floor,
 *  Boston, MA  02110-1301, USA.
 *
 */

#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/list.h>
#include <linux/device.h>
#include <linux/platform_device.h>

#include <asm/bootinfo.h>

#include <asm/mach-adm5120/adm5120_info.h>
#include <asm/mach-adm5120/adm5120_defs.h>
#include <asm/mach-adm5120/adm5120_irq.h>
#include <asm/mach-adm5120/adm5120_board.h>
#include <asm/mach-adm5120/adm5120_platform.h>

static LIST_HEAD(adm5120_boards);
static char adm5120_board_name[ADM5120_BOARD_NAMELEN];

const char *get_system_type(void)
{
	return adm5120_board_name;
}

static struct adm5120_board * __init adm5120_board_find(unsigned long machtype)
{
	struct list_head *this;
	struct adm5120_board *board;
	void *ret;

	ret = NULL;
	list_for_each(this, &adm5120_boards) {
		board = list_entry(this, struct adm5120_board, list);
		if (board->mach_type == machtype) {
			ret = board;
			break;
		}
	}

	return ret;
}

static int __init adm5120_board_setup(void)
{
	struct adm5120_board *board;
	int err;

	board = adm5120_board_find(mips_machtype);
	if (board == NULL) {
		printk(KERN_ALERT "adm5120: no board registered for machtype %lu"
			", trying generic\n", mips_machtype);
		board = adm5120_board_find(MACH_ADM5120_GENERIC);
		if (board == NULL)
			panic("adm5120: unsupported board\n");
	}

	printk(KERN_INFO "adm5120: setting up board '%s'\n", board->name);

	memcpy(&adm5120_board_name, board->name, ADM5120_BOARD_NAMELEN);

	adm5120_board_reset = board->board_reset;
	if (board->eth_num_ports > 0)
		adm5120_eth_num_ports = board->eth_num_ports;

	if (board->eth_vlans)
		memcpy(adm5120_eth_vlans, board->eth_vlans,
			sizeof(adm5120_eth_vlans));


	if (board->board_setup)
		board->board_setup();

	/* register UARTs */
	amba_device_register(&adm5120_uart0_device, &iomem_resource);
	amba_device_register(&adm5120_uart1_device, &iomem_resource);

	/* register PCI controller */
	if (adm5120_package_bga())
		platform_device_register(&adm5120_pci_device);

	/* register board devices */
	if (board->num_devices > 0 && board->devices != NULL ) {
		err = platform_add_devices(board->devices, board->num_devices);
		if (err)
			printk(KERN_ALERT "adm5120: adding board devices failed\n");
	}

	return 0;
}

void __init adm5120_board_register(struct adm5120_board *board)
{
	list_add(&board->list, &adm5120_boards);
	printk(KERN_INFO "adm5120: registered board '%s'\n", board->name);
}

void __init adm5120_register_boards(struct adm5120_board **boards,
		int num)
{
	int i;

	for (i=0; i<num; i++)
		adm5120_board_register(boards[i]);
}

arch_initcall(adm5120_board_setup);