903 lines · 20.5 KB · C
RawDownload
/* * * Procedures for interfacing to the RTAS on CHRP machines. * * Peter Bergner, IBM	March 2001. * Copyright (C) 2001 IBM. * *      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. */ #include <stdarg.h>#include <linux/kernel.h>#include <linux/types.h>#include <linux/spinlock.h>#include <linux/module.h>#include <linux/init.h>#include <linux/capability.h>#include <linux/delay.h> #include <asm/prom.h>#include <asm/rtas.h>#include <asm/hvcall.h>#include <asm/semaphore.h>#include <asm/machdep.h>#include <asm/firmware.h>#include <asm/page.h>#include <asm/param.h>#include <asm/system.h>#include <asm/delay.h>#include <asm/uaccess.h>#include <asm/lmb.h>#include <asm/udbg.h>#include <asm/syscalls.h> struct rtas_t rtas = {	.lock = SPIN_LOCK_UNLOCKED};EXPORT_SYMBOL(rtas); struct rtas_suspend_me_data {	long waiting;	struct rtas_args *args;}; DEFINE_SPINLOCK(rtas_data_buf_lock);EXPORT_SYMBOL(rtas_data_buf_lock); char rtas_data_buf[RTAS_DATA_BUF_SIZE] __cacheline_aligned;EXPORT_SYMBOL(rtas_data_buf); unsigned long rtas_rmo_buf; /* * If non-NULL, this gets called when the kernel terminates. * This is done like this so rtas_flash can be a module. */void (*rtas_flash_term_hook)(int);EXPORT_SYMBOL(rtas_flash_term_hook); /* * call_rtas_display_status and call_rtas_display_status_delay * are designed only for very early low-level debugging, which * is why the token is hard-coded to 10. */static void call_rtas_display_status(char c){	struct rtas_args *args = &rtas.args;	unsigned long s; 	if (!rtas.base)		return;	spin_lock_irqsave(&rtas.lock, s); 	args->token = 10;	args->nargs = 1;	args->nret  = 1;	args->rets  = (rtas_arg_t *)&(args->args[1]);	args->args[0] = (unsigned char)c; 	enter_rtas(__pa(args)); 	spin_unlock_irqrestore(&rtas.lock, s);} static void call_rtas_display_status_delay(char c){	static int pending_newline = 0;  /* did last write end with unprinted newline? */	static int width = 16; 	if (c == '\n') {			while (width-- > 0)			call_rtas_display_status(' ');		width = 16;		mdelay(500);		pending_newline = 1;	} else {		if (pending_newline) {			call_rtas_display_status('\r');			call_rtas_display_status('\n');		} 		pending_newline = 0;		if (width--) {			call_rtas_display_status(c);			udelay(10000);		}	}} void __init udbg_init_rtas_panel(void){	udbg_putc = call_rtas_display_status_delay;} #ifdef CONFIG_UDBG_RTAS_CONSOLE /* If you think you're dying before early_init_dt_scan_rtas() does its * work, you can hard code the token values for your firmware here and * hardcode rtas.base/entry etc. */static unsigned int rtas_putchar_token = RTAS_UNKNOWN_SERVICE;static unsigned int rtas_getchar_token = RTAS_UNKNOWN_SERVICE; static void udbg_rtascon_putc(char c){	int tries; 	if (!rtas.base)		return; 	/* Add CRs before LFs */	if (c == '\n')		udbg_rtascon_putc('\r'); 	/* if there is more than one character to be displayed, wait a bit */	for (tries = 0; tries < 16; tries++) {		if (rtas_call(rtas_putchar_token, 1, 1, NULL, c) == 0)			break;		udelay(1000);	}} static int udbg_rtascon_getc_poll(void){	int c; 	if (!rtas.base)		return -1; 	if (rtas_call(rtas_getchar_token, 0, 2, &c))		return -1; 	return c;} static int udbg_rtascon_getc(void){	int c; 	while ((c = udbg_rtascon_getc_poll()) == -1)		; 	return c;}  void __init udbg_init_rtas_console(void){	udbg_putc = udbg_rtascon_putc;	udbg_getc = udbg_rtascon_getc;	udbg_getc_poll = udbg_rtascon_getc_poll;}#endif /* CONFIG_UDBG_RTAS_CONSOLE */ void rtas_progress(char *s, unsigned short hex){	struct device_node *root;	int width;	const int *p;	char *os;	static int display_character, set_indicator;	static int display_width, display_lines, form_feed;	static const int *row_width;	static DEFINE_SPINLOCK(progress_lock);	static int current_line;	static int pending_newline = 0;  /* did last write end with unprinted newline? */ 	if (!rtas.base)		return; 	if (display_width == 0) {		display_width = 0x10;		if ((root = find_path_device("/rtas"))) {			if ((p = get_property(root,					"ibm,display-line-length", NULL)))				display_width = *p;			if ((p = get_property(root,					"ibm,form-feed", NULL)))				form_feed = *p;			if ((p = get_property(root,					"ibm,display-number-of-lines", NULL)))				display_lines = *p;			row_width = get_property(root,					"ibm,display-truncation-length", NULL);		}		display_character = rtas_token("display-character");		set_indicator = rtas_token("set-indicator");	} 	if (display_character == RTAS_UNKNOWN_SERVICE) {		/* use hex display if available */		if (set_indicator != RTAS_UNKNOWN_SERVICE)			rtas_call(set_indicator, 3, 1, NULL, 6, 0, hex);		return;	} 	spin_lock(&progress_lock); 	/*	 * Last write ended with newline, but we didn't print it since	 * it would just clear the bottom line of output. Print it now	 * instead.	 *	 * If no newline is pending and form feed is supported, clear the	 * display with a form feed; otherwise, print a CR to start output	 * at the beginning of the line.	 */	if (pending_newline) {		rtas_call(display_character, 1, 1, NULL, '\r');		rtas_call(display_character, 1, 1, NULL, '\n');		pending_newline = 0;	} else {		current_line = 0;		if (form_feed)			rtas_call(display_character, 1, 1, NULL,				  (char)form_feed);		else			rtas_call(display_character, 1, 1, NULL, '\r');	} 	if (row_width)		width = row_width[current_line];	else		width = display_width;	os = s;	while (*os) {		if (*os == '\n' || *os == '\r') {			/* If newline is the last character, save it			 * until next call to avoid bumping up the			 * display output.			 */			if (*os == '\n' && !os[1]) {				pending_newline = 1;				current_line++;				if (current_line > display_lines-1)					current_line = display_lines-1;				spin_unlock(&progress_lock);				return;			} 			/* RTAS wants CR-LF, not just LF */ 			if (*os == '\n') {				rtas_call(display_character, 1, 1, NULL, '\r');				rtas_call(display_character, 1, 1, NULL, '\n');			} else {				/* CR might be used to re-draw a line, so we'll				 * leave it alone and not add LF.				 */				rtas_call(display_character, 1, 1, NULL, *os);			} 			if (row_width)				width = row_width[current_line];			else				width = display_width;		} else {			width--;			rtas_call(display_character, 1, 1, NULL, *os);		} 		os++; 		/* if we overwrite the screen length */		if (width <= 0)			while ((*os != 0) && (*os != '\n') && (*os != '\r'))				os++;	} 	spin_unlock(&progress_lock);}EXPORT_SYMBOL(rtas_progress);		/* needed by rtas_flash module */ int rtas_token(const char *service){	const int *tokp;	if (rtas.dev == NULL)		return RTAS_UNKNOWN_SERVICE;	tokp = get_property(rtas.dev, service, NULL);	return tokp ? *tokp : RTAS_UNKNOWN_SERVICE;}EXPORT_SYMBOL(rtas_token); int rtas_service_present(const char *service){	return rtas_token(service) != RTAS_UNKNOWN_SERVICE;}EXPORT_SYMBOL(rtas_service_present); #ifdef CONFIG_RTAS_ERROR_LOGGING/* * Return the firmware-specified size of the error log buffer *  for all rtas calls that require an error buffer argument. *  This includes 'check-exception' and 'rtas-last-error'. */int rtas_get_error_log_max(void){	static int rtas_error_log_max;	if (rtas_error_log_max)		return rtas_error_log_max; 	rtas_error_log_max = rtas_token ("rtas-error-log-max");	if ((rtas_error_log_max == RTAS_UNKNOWN_SERVICE) ||	    (rtas_error_log_max > RTAS_ERROR_LOG_MAX)) {		printk (KERN_WARNING "RTAS: bad log buffer size %d\n",			rtas_error_log_max);		rtas_error_log_max = RTAS_ERROR_LOG_MAX;	}	return rtas_error_log_max;}EXPORT_SYMBOL(rtas_get_error_log_max);  char rtas_err_buf[RTAS_ERROR_LOG_MAX];int rtas_last_error_token; /** Return a copy of the detailed error text associated with the *  most recent failed call to rtas.  Because the error text *  might go stale if there are any other intervening rtas calls, *  this routine must be called atomically with whatever produced *  the error (i.e. with rtas.lock still held from the previous call). */static char *__fetch_rtas_last_error(char *altbuf){	struct rtas_args err_args, save_args;	u32 bufsz;	char *buf = NULL; 	if (rtas_last_error_token == -1)		return NULL; 	bufsz = rtas_get_error_log_max(); 	err_args.token = rtas_last_error_token;	err_args.nargs = 2;	err_args.nret = 1;	err_args.args[0] = (rtas_arg_t)__pa(rtas_err_buf);	err_args.args[1] = bufsz;	err_args.args[2] = 0; 	save_args = rtas.args;	rtas.args = err_args; 	enter_rtas(__pa(&rtas.args)); 	err_args = rtas.args;	rtas.args = save_args; 	/* Log the error in the unlikely case that there was one. */	if (unlikely(err_args.args[2] == 0)) {		if (altbuf) {			buf = altbuf;		} else {			buf = rtas_err_buf;			if (mem_init_done)				buf = kmalloc(RTAS_ERROR_LOG_MAX, GFP_ATOMIC);		}		if (buf)			memcpy(buf, rtas_err_buf, RTAS_ERROR_LOG_MAX);	} 	return buf;} #define get_errorlog_buffer()	kmalloc(RTAS_ERROR_LOG_MAX, GFP_KERNEL) #else /* CONFIG_RTAS_ERROR_LOGGING */#define __fetch_rtas_last_error(x)	NULL#define get_errorlog_buffer()		NULL#endif int rtas_call(int token, int nargs, int nret, int *outputs, ...){	va_list list;	int i;	unsigned long s;	struct rtas_args *rtas_args;	char *buff_copy = NULL;	int ret; 	if (!rtas.entry || token == RTAS_UNKNOWN_SERVICE)		return -1; 	/* Gotta do something different here, use global lock for now... */	spin_lock_irqsave(&rtas.lock, s);	rtas_args = &rtas.args; 	rtas_args->token = token;	rtas_args->nargs = nargs;	rtas_args->nret  = nret;	rtas_args->rets  = (rtas_arg_t *)&(rtas_args->args[nargs]);	va_start(list, outputs);	for (i = 0; i < nargs; ++i)		rtas_args->args[i] = va_arg(list, rtas_arg_t);	va_end(list); 	for (i = 0; i < nret; ++i)		rtas_args->rets[i] = 0; 	enter_rtas(__pa(rtas_args)); 	/* A -1 return code indicates that the last command couldn't	   be completed due to a hardware error. */	if (rtas_args->rets[0] == -1)		buff_copy = __fetch_rtas_last_error(NULL); 	if (nret > 1 && outputs != NULL)		for (i = 0; i < nret-1; ++i)			outputs[i] = rtas_args->rets[i+1];	ret = (nret > 0)? rtas_args->rets[0]: 0; 	/* Gotta do something different here, use global lock for now... */	spin_unlock_irqrestore(&rtas.lock, s); 	if (buff_copy) {		log_error(buff_copy, ERR_TYPE_RTAS_LOG, 0);		if (mem_init_done)			kfree(buff_copy);	}	return ret;}EXPORT_SYMBOL(rtas_call); /* For RTAS_BUSY (-2), delay for 1 millisecond.  For an extended busy status * code of 990n, perform the hinted delay of 10^n (last digit) milliseconds. */unsigned int rtas_busy_delay_time(int status){	int order;	unsigned int ms = 0; 	if (status == RTAS_BUSY) {		ms = 1;	} else if (status >= 9900 && status <= 9905) {		order = status - 9900;		for (ms = 1; order > 0; order--)			ms *= 10;	} 	return ms;}EXPORT_SYMBOL(rtas_busy_delay_time); /* For an RTAS busy status code, perform the hinted delay. */unsigned int rtas_busy_delay(int status){	unsigned int ms; 	might_sleep();	ms = rtas_busy_delay_time(status);	if (ms)		msleep(ms); 	return ms;}EXPORT_SYMBOL(rtas_busy_delay); int rtas_error_rc(int rtas_rc){	int rc; 	switch (rtas_rc) {		case -1: 		/* Hardware Error */			rc = -EIO;			break;		case -3:		/* Bad indicator/domain/etc */			rc = -EINVAL;			break;		case -9000:		/* Isolation error */			rc = -EFAULT;			break;		case -9001:		/* Outstanding TCE/PTE */			rc = -EEXIST;			break;		case -9002:		/* No usable slot */			rc = -ENODEV;			break;		default:

Lines 1–500 of 903.