diff options
| -rw-r--r-- | common/Makefile | 1 | ||||
| -rw-r--r-- | common/modem.c | 118 | ||||
| -rw-r--r-- | lib_arm/board.c | 99 | ||||
| -rw-r--r-- | lib_ppc/board.c | 97 | 
4 files changed, 119 insertions, 196 deletions
| diff --git a/common/Makefile b/common/Makefile index b9f4ca79c..2ca10264c 100644 --- a/common/Makefile +++ b/common/Makefile @@ -155,6 +155,7 @@ COBJS-y += flash.o  COBJS-$(CONFIG_CMD_KGDB) += kgdb.o  COBJS-$(CONFIG_LCD) += lcd.o  COBJS-$(CONFIG_LYNXKDI) += lynxkdi.o +COBJS-$(CONFIG_MODEM_SUPPORT) += modem.o  COBJS-$(CONFIG_UPDATE_TFTP) += update.o  COBJS-$(CONFIG_USB_KEYBOARD) += usb_kbd.o diff --git a/common/modem.c b/common/modem.c new file mode 100644 index 000000000..a017b2963 --- /dev/null +++ b/common/modem.c @@ -0,0 +1,118 @@ +/* + * (C) Copyright 2002-2009 + * Wolfgang Denk, DENX Software Engineering, wd@denx.de. + * + * 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. + * + * 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., 59 Temple Place, Suite 330, Boston, + * MA 02111-1307 USA + */ + +#include <common.h> + +/* 'inline' - We have to do it fast */ +static inline void mdm_readline(char *buf, int bufsiz) +{ +	char c; +	char *p; +	int n; + +	n = 0; +	p = buf; +	for(;;) { +		c = serial_getc(); + +		/*		dbg("(%c)", c); */ + +		switch(c) { +		case '\r': +			break; +		case '\n': +			*p = '\0'; +			return; + +		default: +			if(n++ > bufsiz) { +				*p = '\0'; +				return; /* sanity check */ +			} +			*p = c; +			p++; +			break; +		} +	} +} + +extern void  dbg(const char *fmt, ...); +int mdm_init (void) +{ +	char env_str[16]; +	char *init_str; +	int i; +	extern char console_buffer[]; +	extern void enable_putc(void); +	extern int hwflow_onoff(int); + +	enable_putc(); /* enable serial_putc() */ + +#ifdef CONFIG_HWFLOW +	init_str = getenv("mdm_flow_control"); +	if (init_str && (strcmp(init_str, "rts/cts") == 0)) +		hwflow_onoff (1); +	else +		hwflow_onoff(-1); +#endif + +	for (i = 1;;i++) { +		sprintf(env_str, "mdm_init%d", i); +		if ((init_str = getenv(env_str)) != NULL) { +			serial_puts(init_str); +			serial_puts("\n"); +			for(;;) { +				mdm_readline(console_buffer, CONFIG_SYS_CBSIZE); +				dbg("ini%d: [%s]", i, console_buffer); + +				if ((strcmp(console_buffer, "OK") == 0) || +					(strcmp(console_buffer, "ERROR") == 0)) { +					dbg("ini%d: cmd done", i); +					break; +				} else /* in case we are originating call ... */ +					if (strncmp(console_buffer, "CONNECT", 7) == 0) { +						dbg("ini%d: connect", i); +						return 0; +					} +			} +		} else +			break; /* no init string - stop modem init */ + +		udelay(100000); +	} + +	udelay(100000); + +	/* final stage - wait for connect */ +	for(;i > 1;) { /* if 'i' > 1 - wait for connection +				  message from modem */ +		mdm_readline(console_buffer, CONFIG_SYS_CBSIZE); +		dbg("ini_f: [%s]", console_buffer); +		if (strncmp(console_buffer, "CONNECT", 7) == 0) { +			dbg("ini_f: connected"); +			return 0; +		} +	} + +	return 0; +} diff --git a/lib_arm/board.c b/lib_arm/board.c index 5c3bfecea..4236c9420 100644 --- a/lib_arm/board.c +++ b/lib_arm/board.c @@ -472,102 +472,3 @@ void hang (void)  	puts ("### ERROR ### Please RESET the board ###\n");  	for (;;);  } - -#ifdef CONFIG_MODEM_SUPPORT -static inline void mdm_readline(char *buf, int bufsiz); - -/* called from main loop (common/main.c) */ -extern void  dbg(const char *fmt, ...); -int mdm_init (void) -{ -	char env_str[16]; -	char *init_str; -	int i; -	extern char console_buffer[]; -	extern void enable_putc(void); -	extern int hwflow_onoff(int); - -	enable_putc(); /* enable serial_putc() */ - -#ifdef CONFIG_HWFLOW -	init_str = getenv("mdm_flow_control"); -	if (init_str && (strcmp(init_str, "rts/cts") == 0)) -		hwflow_onoff (1); -	else -		hwflow_onoff(-1); -#endif - -	for (i = 1;;i++) { -		sprintf(env_str, "mdm_init%d", i); -		if ((init_str = getenv(env_str)) != NULL) { -			serial_puts(init_str); -			serial_puts("\n"); -			for(;;) { -				mdm_readline(console_buffer, CONFIG_SYS_CBSIZE); -				dbg("ini%d: [%s]", i, console_buffer); - -				if ((strcmp(console_buffer, "OK") == 0) || -					(strcmp(console_buffer, "ERROR") == 0)) { -					dbg("ini%d: cmd done", i); -					break; -				} else /* in case we are originating call ... */ -					if (strncmp(console_buffer, "CONNECT", 7) == 0) { -						dbg("ini%d: connect", i); -						return 0; -					} -			} -		} else -			break; /* no init string - stop modem init */ - -		udelay(100000); -	} - -	udelay(100000); - -	/* final stage - wait for connect */ -	for(;i > 1;) { /* if 'i' > 1 - wait for connection -				  message from modem */ -		mdm_readline(console_buffer, CONFIG_SYS_CBSIZE); -		dbg("ini_f: [%s]", console_buffer); -		if (strncmp(console_buffer, "CONNECT", 7) == 0) { -			dbg("ini_f: connected"); -			return 0; -		} -	} - -	return 0; -} - -/* 'inline' - We have to do it fast */ -static inline void mdm_readline(char *buf, int bufsiz) -{ -	char c; -	char *p; -	int n; - -	n = 0; -	p = buf; -	for(;;) { -		c = serial_getc(); - -		/*		dbg("(%c)", c); */ - -		switch(c) { -		case '\r': -			break; -		case '\n': -			*p = '\0'; -			return; - -		default: -			if(n++ > bufsiz) { -				*p = '\0'; -				return; /* sanity check */ -			} -			*p = c; -			p++; -			break; -		} -	} -} -#endif	/* CONFIG_MODEM_SUPPORT */ diff --git a/lib_ppc/board.c b/lib_ppc/board.c index a0e6b208a..e0d9ba4ef 100644 --- a/lib_ppc/board.c +++ b/lib_ppc/board.c @@ -1157,103 +1157,6 @@ void hang (void)  	for (;;);  } -#ifdef CONFIG_MODEM_SUPPORT -/* called from main loop (common/main.c) */ -/* 'inline' - We have to do it fast */ -static inline void mdm_readline(char *buf, int bufsiz) -{ -	char c; -	char *p; -	int n; - -	n = 0; -	p = buf; -	for(;;) { -		c = serial_getc(); - -		/*		dbg("(%c)", c); */ - -		switch(c) { -		case '\r': -			break; -		case '\n': -			*p = '\0'; -			return; - -		default: -			if(n++ > bufsiz) { -				*p = '\0'; -				return; /* sanity check */ -			} -			*p = c; -			p++; -			break; -		} -	} -} - -extern void  dbg(const char *fmt, ...); -int mdm_init (void) -{ -	char env_str[16]; -	char *init_str; -	int i; -	extern char console_buffer[]; -	extern void enable_putc(void); -	extern int hwflow_onoff(int); - -	enable_putc(); /* enable serial_putc() */ - -#ifdef CONFIG_HWFLOW -	init_str = getenv("mdm_flow_control"); -	if (init_str && (strcmp(init_str, "rts/cts") == 0)) -		hwflow_onoff (1); -	else -		hwflow_onoff(-1); -#endif - -	for (i = 1;;i++) { -		sprintf(env_str, "mdm_init%d", i); -		if ((init_str = getenv(env_str)) != NULL) { -			serial_puts(init_str); -			serial_puts("\n"); -			for(;;) { -				mdm_readline(console_buffer, CONFIG_SYS_CBSIZE); -				dbg("ini%d: [%s]", i, console_buffer); - -				if ((strcmp(console_buffer, "OK") == 0) || -					(strcmp(console_buffer, "ERROR") == 0)) { -					dbg("ini%d: cmd done", i); -					break; -				} else /* in case we are originating call ... */ -					if (strncmp(console_buffer, "CONNECT", 7) == 0) { -						dbg("ini%d: connect", i); -						return 0; -					} -			} -		} else -			break; /* no init string - stop modem init */ - -		udelay(100000); -	} - -	udelay(100000); - -	/* final stage - wait for connect */ -	for(;i > 1;) { /* if 'i' > 1 - wait for connection -				  message from modem */ -		mdm_readline(console_buffer, CONFIG_SYS_CBSIZE); -		dbg("ini_f: [%s]", console_buffer); -		if (strncmp(console_buffer, "CONNECT", 7) == 0) { -			dbg("ini_f: connected"); -			return 0; -		} -	} - -	return 0; -} - -#endif  #if 0 /* We could use plain global data, but the resulting code is bigger */  /* |