| /* |
| * linux/arch/arm/mach-omap/common.c |
| * |
| * Code common to all OMAP machines. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 as |
| * published by the Free Software Foundation. |
| */ |
| #include <linux/config.h> |
| #include <linux/module.h> |
| #include <linux/kernel.h> |
| #include <linux/init.h> |
| #include <linux/delay.h> |
| #include <linux/pm.h> |
| #include <linux/console.h> |
| #include <linux/serial.h> |
| #include <linux/tty.h> |
| #include <linux/serial_8250.h> |
| #include <linux/serial_reg.h> |
| |
| #include <asm/hardware.h> |
| #include <asm/system.h> |
| #include <asm/pgtable.h> |
| #include <asm/mach/map.h> |
| #include <asm/hardware/clock.h> |
| #include <asm/io.h> |
| #include <asm/mach-types.h> |
| |
| #include <asm/arch/board.h> |
| #include <asm/arch/mux.h> |
| #include <asm/arch/fpga.h> |
| |
| #include "clock.h" |
| |
| #define NO_LENGTH_CHECK 0xffffffff |
| |
| extern int omap_bootloader_tag_len; |
| extern u8 omap_bootloader_tag[]; |
| |
| struct omap_board_config_kernel *omap_board_config; |
| int omap_board_config_size = 0; |
| |
| static const void *get_config(u16 tag, size_t len, int skip, size_t *len_out) |
| { |
| struct omap_board_config_kernel *kinfo = NULL; |
| int i; |
| |
| #ifdef CONFIG_OMAP_BOOT_TAG |
| struct omap_board_config_entry *info = NULL; |
| |
| if (omap_bootloader_tag_len > 4) |
| info = (struct omap_board_config_entry *) omap_bootloader_tag; |
| while (info != NULL) { |
| u8 *next; |
| |
| if (info->tag == tag) { |
| if (skip == 0) |
| break; |
| skip--; |
| } |
| |
| if ((info->len & 0x03) != 0) { |
| /* We bail out to avoid an alignment fault */ |
| printk(KERN_ERR "OMAP peripheral config: Length (%d) not word-aligned (tag %04x)\n", |
| info->len, info->tag); |
| return NULL; |
| } |
| next = (u8 *) info + sizeof(*info) + info->len; |
| if (next >= omap_bootloader_tag + omap_bootloader_tag_len) |
| info = NULL; |
| else |
| info = (struct omap_board_config_entry *) next; |
| } |
| if (info != NULL) { |
| /* Check the length as a lame attempt to check for |
| * binary inconsistancy. */ |
| if (len != NO_LENGTH_CHECK) { |
| /* Word-align len */ |
| if (len & 0x03) |
| len = (len + 3) & ~0x03; |
| if (info->len != len) { |
| printk(KERN_ERR "OMAP peripheral config: Length mismatch with tag %x (want %d, got %d)\n", |
| tag, len, info->len); |
| return NULL; |
| } |
| } |
| if (len_out != NULL) |
| *len_out = info->len; |
| return info->data; |
| } |
| #endif |
| /* Try to find the config from the board-specific structures |
| * in the kernel. */ |
| for (i = 0; i < omap_board_config_size; i++) { |
| if (omap_board_config[i].tag == tag) { |
| kinfo = &omap_board_config[i]; |
| break; |
| } |
| } |
| if (kinfo == NULL) |
| return NULL; |
| return kinfo->data; |
| } |
| |
| const void *__omap_get_config(u16 tag, size_t len, int nr) |
| { |
| return get_config(tag, len, nr, NULL); |
| } |
| EXPORT_SYMBOL(__omap_get_config); |
| |
| const void *omap_get_var_config(u16 tag, size_t *len) |
| { |
| return get_config(tag, NO_LENGTH_CHECK, 0, len); |
| } |
| EXPORT_SYMBOL(omap_get_var_config); |
| |
| static int __init omap_add_serial_console(void) |
| { |
| const struct omap_serial_console_config *info; |
| |
| info = omap_get_config(OMAP_TAG_SERIAL_CONSOLE, |
| struct omap_serial_console_config); |
| if (info != NULL && info->console_uart) { |
| static char speed[11], *opt = NULL; |
| |
| if (info->console_speed) { |
| snprintf(speed, sizeof(speed), "%u", info->console_speed); |
| opt = speed; |
| } |
| return add_preferred_console("ttyS", info->console_uart - 1, opt); |
| } |
| return 0; |
| } |
| console_initcall(omap_add_serial_console); |