1a9e93cc81
dev_add_child is a very unsafe function. If called multiple times
it allows setting the same device to different parents thus corrupting
the siblings list. This happens regularly since:
| commit c2e568d19c
| Author: Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
| Date: Sat Nov 3 16:11:05 2012 +0100
|
| bus: add bus device
|
| automatically add it as parent of any bus device if none already specified
|
| we have now a nice output per bus
If for example a FATfs is mounted this nice output per bus often ends with:
> `---- fat0
> `---- 0
> `---- 0x86f0000087020031-0x86f000410df27124: /dev/<NULL>
> `---- sram00
> `---- 0x00000000-0xffffffffffffffff: /dev/<NULL>
> `---- 0x00000000-0xffffffffffffffff: /dev/<NULL>
> unable to handle NULL pointer dereference at address 0x0000000c
> pc : [<87f08a20>] lr : [<87f08a04>]
> sp : 86eff8c0 ip : 87f3fbde fp : ffffffff
> r10: ffffffff r9 : 00000000 r8 : 00000003
> r7 : 86f075b8 r6 : 00000002 r5 : ffffffec r4 : 86f07544
> r3 : 00000000 r2 : 43f900b4 r1 : 00000020 r0 : 00000005
> Flags: Nzcv IRQs off FIQs off Mode SVC_32
> [<87f08a20>] (do_devinfo_subtree+0x90/0x130) from [<87f08a90>] (do_devinfo_subtree+0x100/0x130)
>
> [<87f3e070>] (unwind_backtrace+0x0/0x90) from [<87f28514>] (panic+0x28/0x3c)
> [<87f28514>] (panic+0x28/0x3c) from [<87f3e4b8>] (do_exception+0x10/0x14)
> [<87f3e4b8>] (do_exception+0x10/0x14) from [<87f3e544>] (do_data_abort+0x2c/0x38)
> [<87f3e544>] (do_data_abort+0x2c/0x38) from [<87f3e268>] (data_abort+0x48/0x60)
This patch fixes this by adding a device to its parents children list in
register_device so that dev_add_child is no longer needed. This function
is removed from the tree. Now callers of register_device have to clearly
set the parent *before* registering a device.
Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
Reported-by: Jan Lübbe <jlu@pengutronix.de>
434 lines
8.4 KiB
C
434 lines
8.4 KiB
C
/*
|
|
* (C) Copyright 2000
|
|
* Paolo Scaffardi, AIRVENT SAM s.p.a - RIMINI(ITALY), arsenio@tin.it
|
|
*
|
|
* See file CREDITS for list of people who contributed to this
|
|
* project.
|
|
*
|
|
* 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.
|
|
*
|
|
*/
|
|
|
|
#include <config.h>
|
|
#include <common.h>
|
|
#include <stdarg.h>
|
|
#include <malloc.h>
|
|
#include <param.h>
|
|
#include <console.h>
|
|
#include <driver.h>
|
|
#include <fs.h>
|
|
#include <init.h>
|
|
#include <clock.h>
|
|
#include <kfifo.h>
|
|
#include <module.h>
|
|
#include <poller.h>
|
|
#include <linux/list.h>
|
|
#include <linux/stringify.h>
|
|
#include <debug_ll.h>
|
|
|
|
LIST_HEAD(console_list);
|
|
EXPORT_SYMBOL(console_list);
|
|
|
|
#define CONSOLE_UNINITIALIZED 0
|
|
#define CONSOLE_INITIALIZED_BUFFER 1
|
|
#define CONSOLE_INIT_FULL 2
|
|
|
|
#define to_console_dev(d) container_of(d, struct console_device, class_dev)
|
|
|
|
static int initialized = 0;
|
|
|
|
#define CONSOLE_BUFFER_SIZE 1024
|
|
|
|
static char console_input_buffer[CONSOLE_BUFFER_SIZE];
|
|
static char console_output_buffer[CONSOLE_BUFFER_SIZE];
|
|
|
|
static struct kfifo __console_input_fifo;
|
|
static struct kfifo __console_output_fifo;
|
|
static struct kfifo *console_input_fifo = &__console_input_fifo;
|
|
static struct kfifo *console_output_fifo = &__console_output_fifo;
|
|
|
|
static int console_std_set(struct device_d *dev, struct param_d *param,
|
|
const char *val)
|
|
{
|
|
struct console_device *cdev = to_console_dev(dev);
|
|
char active[4];
|
|
unsigned int flag = 0, i = 0;
|
|
|
|
if (!val)
|
|
dev_param_set_generic(dev, param, NULL);
|
|
|
|
if (strchr(val, 'i') && cdev->f_caps & CONSOLE_STDIN) {
|
|
active[i++] = 'i';
|
|
flag |= CONSOLE_STDIN;
|
|
}
|
|
|
|
if (strchr(val, 'o') && cdev->f_caps & CONSOLE_STDOUT) {
|
|
active[i++] = 'o';
|
|
flag |= CONSOLE_STDOUT;
|
|
}
|
|
|
|
if (strchr(val, 'e') && cdev->f_caps & CONSOLE_STDERR) {
|
|
active[i++] = 'e';
|
|
flag |= CONSOLE_STDERR;
|
|
}
|
|
|
|
active[i] = 0;
|
|
cdev->f_active = flag;
|
|
|
|
dev_param_set_generic(dev, param, active);
|
|
|
|
if (initialized < CONSOLE_INIT_FULL) {
|
|
char ch;
|
|
initialized = CONSOLE_INIT_FULL;
|
|
PUTS_LL("Switch to console [");
|
|
PUTS_LL(dev_name(dev));
|
|
PUTS_LL("]\n");
|
|
barebox_banner();
|
|
while (kfifo_getc(console_output_fifo, &ch) == 0)
|
|
console_putc(CONSOLE_STDOUT, ch);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int console_baudrate_set(struct device_d *dev, struct param_d *param,
|
|
const char *val)
|
|
{
|
|
struct console_device *cdev = to_console_dev(dev);
|
|
int baudrate;
|
|
char baudstr[16];
|
|
unsigned char c;
|
|
|
|
if (!val)
|
|
dev_param_set_generic(dev, param, NULL);
|
|
|
|
baudrate = simple_strtoul(val, NULL, 10);
|
|
|
|
if (cdev->f_active) {
|
|
printf("## Switch baudrate to %d bps and press ENTER ...\n",
|
|
baudrate);
|
|
mdelay(50);
|
|
cdev->setbrg(cdev, baudrate);
|
|
mdelay(50);
|
|
do {
|
|
c = getc();
|
|
} while (c != '\r' && c != '\n');
|
|
} else
|
|
cdev->setbrg(cdev, baudrate);
|
|
|
|
sprintf(baudstr, "%d", baudrate);
|
|
dev_param_set_generic(dev, param, baudstr);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void console_init_early(void)
|
|
{
|
|
kfifo_init(console_input_fifo, console_input_buffer,
|
|
CONSOLE_BUFFER_SIZE);
|
|
kfifo_init(console_output_fifo, console_output_buffer,
|
|
CONSOLE_BUFFER_SIZE);
|
|
|
|
initialized = CONSOLE_INITIALIZED_BUFFER;
|
|
}
|
|
|
|
int console_register(struct console_device *newcdev)
|
|
{
|
|
struct device_d *dev = &newcdev->class_dev;
|
|
int activate = 0;
|
|
|
|
if (initialized == CONSOLE_UNINITIALIZED)
|
|
console_init_early();
|
|
|
|
dev->id = DEVICE_ID_DYNAMIC;
|
|
strcpy(dev->name, "cs");
|
|
if (newcdev->dev)
|
|
dev->parent = newcdev->dev;
|
|
platform_device_register(dev);
|
|
|
|
if (newcdev->setbrg) {
|
|
dev_add_param(dev, "baudrate", console_baudrate_set, NULL, 0);
|
|
dev_set_param(dev, "baudrate", __stringify(CONFIG_BAUDRATE));
|
|
}
|
|
|
|
dev_add_param(dev, "active", console_std_set, NULL, 0);
|
|
|
|
if (IS_ENABLED(CONFIG_CONSOLE_ACTIVATE_FIRST)) {
|
|
if (list_empty(&console_list))
|
|
activate = 1;
|
|
} else if (IS_ENABLED(CONFIG_CONSOLE_ACTIVATE_ALL)) {
|
|
activate = 1;
|
|
}
|
|
|
|
if (newcdev->dev && of_device_is_stdout_path(newcdev->dev))
|
|
activate = 1;
|
|
|
|
list_add_tail(&newcdev->list, &console_list);
|
|
|
|
if (activate)
|
|
dev_set_param(dev, "active", "ioe");
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL(console_register);
|
|
|
|
int console_unregister(struct console_device *cdev)
|
|
{
|
|
struct device_d *dev = &cdev->class_dev;
|
|
int status;
|
|
|
|
list_del(&cdev->list);
|
|
if (list_empty(&console_list))
|
|
initialized = CONSOLE_UNINITIALIZED;
|
|
|
|
status = unregister_device(dev);
|
|
if (!status)
|
|
memset(cdev, 0, sizeof(*cdev));
|
|
return status;
|
|
}
|
|
EXPORT_SYMBOL(console_unregister);
|
|
|
|
static int getc_raw(void)
|
|
{
|
|
struct console_device *cdev;
|
|
int active = 0;
|
|
|
|
while (1) {
|
|
for_each_console(cdev) {
|
|
if (!(cdev->f_active & CONSOLE_STDIN))
|
|
continue;
|
|
active = 1;
|
|
if (cdev->tstc(cdev))
|
|
return cdev->getc(cdev);
|
|
}
|
|
if (!active)
|
|
/* no active console found. bail out */
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
static int tstc_raw(void)
|
|
{
|
|
struct console_device *cdev;
|
|
|
|
for_each_console(cdev) {
|
|
if (!(cdev->f_active & CONSOLE_STDIN))
|
|
continue;
|
|
if (cdev->tstc(cdev))
|
|
return 1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int getc(void)
|
|
{
|
|
unsigned char ch;
|
|
uint64_t start;
|
|
|
|
/*
|
|
* For 100us we read the characters from the serial driver
|
|
* into a kfifo. This helps us not to lose characters
|
|
* in small hardware fifos.
|
|
*/
|
|
start = get_time_ns();
|
|
while (1) {
|
|
if (tstc_raw()) {
|
|
kfifo_putc(console_input_fifo, getc_raw());
|
|
|
|
start = get_time_ns();
|
|
}
|
|
if (is_timeout(start, 100 * USECOND) &&
|
|
kfifo_len(console_input_fifo))
|
|
break;
|
|
}
|
|
|
|
kfifo_getc(console_input_fifo, &ch);
|
|
return ch;
|
|
}
|
|
EXPORT_SYMBOL(getc);
|
|
|
|
int fgetc(int fd)
|
|
{
|
|
char c;
|
|
|
|
if (!fd)
|
|
return getc();
|
|
return read(fd, &c, 1);
|
|
}
|
|
EXPORT_SYMBOL(fgetc);
|
|
|
|
int tstc(void)
|
|
{
|
|
return kfifo_len(console_input_fifo) || tstc_raw();
|
|
}
|
|
EXPORT_SYMBOL(tstc);
|
|
|
|
void console_putc(unsigned int ch, char c)
|
|
{
|
|
struct console_device *cdev;
|
|
int init = initialized;
|
|
|
|
switch (init) {
|
|
case CONSOLE_UNINITIALIZED:
|
|
console_init_early();
|
|
/* fall through */
|
|
|
|
case CONSOLE_INITIALIZED_BUFFER:
|
|
kfifo_putc(console_output_fifo, c);
|
|
PUTC_LL(c);
|
|
return;
|
|
|
|
case CONSOLE_INIT_FULL:
|
|
for_each_console(cdev) {
|
|
if (cdev->f_active & ch) {
|
|
if (c == '\n')
|
|
cdev->putc(cdev, '\r');
|
|
cdev->putc(cdev, c);
|
|
}
|
|
}
|
|
return;
|
|
default:
|
|
/* If we have problems inititalizing our data
|
|
* get them early
|
|
*/
|
|
hang();
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(console_putc);
|
|
|
|
int fputc(int fd, char c)
|
|
{
|
|
if(list_empty(&console_list)) {
|
|
if(!fd)
|
|
console_putc(0, c);
|
|
return 0;
|
|
}
|
|
|
|
if (fd == 1)
|
|
putchar(c);
|
|
else if (fd == 2)
|
|
eputc(c);
|
|
else
|
|
return write(fd, &c, 1);
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL(fputc);
|
|
|
|
int console_puts(unsigned int ch, const char *str)
|
|
{
|
|
const char *s = str;
|
|
int n = 0;
|
|
|
|
while (*s) {
|
|
if (*s == '\n') {
|
|
console_putc(ch, '\r');
|
|
n++;
|
|
}
|
|
console_putc(ch, *s);
|
|
n++;
|
|
s++;
|
|
}
|
|
return n;
|
|
}
|
|
EXPORT_SYMBOL(console_puts);
|
|
|
|
int fputs(int fd, const char *s)
|
|
{
|
|
if (fd == 1)
|
|
return puts(s);
|
|
else if (fd == 2)
|
|
return eputs(s);
|
|
else
|
|
return write(fd, s, strlen(s));
|
|
}
|
|
EXPORT_SYMBOL(fputs);
|
|
|
|
void console_flush(void)
|
|
{
|
|
struct console_device *cdev;
|
|
|
|
for_each_console(cdev) {
|
|
if (cdev->flush)
|
|
cdev->flush(cdev);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(console_flush);
|
|
|
|
int fprintf(int file, const char *fmt, ...)
|
|
{
|
|
va_list args;
|
|
char printbuffer[CFG_PBSIZE];
|
|
|
|
va_start (args, fmt);
|
|
|
|
/* For this to work, printbuffer must be larger than
|
|
* anything we ever want to print.
|
|
*/
|
|
vsprintf (printbuffer, fmt, args);
|
|
va_end (args);
|
|
|
|
/* Print the string */
|
|
return fputs(file, printbuffer);
|
|
}
|
|
EXPORT_SYMBOL(fprintf);
|
|
|
|
int printf (const char *fmt, ...)
|
|
{
|
|
va_list args;
|
|
uint i;
|
|
char printbuffer[CFG_PBSIZE];
|
|
|
|
va_start (args, fmt);
|
|
|
|
/* For this to work, printbuffer must be larger than
|
|
* anything we ever want to print.
|
|
*/
|
|
i = vsprintf (printbuffer, fmt, args);
|
|
va_end (args);
|
|
|
|
/* Print the string */
|
|
puts (printbuffer);
|
|
|
|
return i;
|
|
}
|
|
EXPORT_SYMBOL(printf);
|
|
|
|
int vprintf (const char *fmt, va_list args)
|
|
{
|
|
uint i;
|
|
char printbuffer[CFG_PBSIZE];
|
|
|
|
/* For this to work, printbuffer must be larger than
|
|
* anything we ever want to print.
|
|
*/
|
|
i = vsprintf (printbuffer, fmt, args);
|
|
|
|
/* Print the string */
|
|
puts (printbuffer);
|
|
|
|
return i;
|
|
}
|
|
EXPORT_SYMBOL(vprintf);
|
|
|
|
#ifndef ARCH_HAS_CTRLC
|
|
/* test if ctrl-c was pressed */
|
|
int ctrlc (void)
|
|
{
|
|
poller_call();
|
|
|
|
if (tstc() && getc() == 3)
|
|
return 1;
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL(ctrlc);
|
|
#endif /* ARCH_HAS_CTRC */
|