common/modem.c

   1 /*
   2  * (C) Copyright 2002-2009
   3  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   4  *
   5  * See file CREDITS for list of people who contributed to this
   6  * project.
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License as
  10  * published by the Free Software Foundation; either version 2 of
  11  * the License, or (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21  * MA 02111-1307 USA
  22  */
  23
  24 #include <common.h>
  25
  26 /* 'inline' - We have to do it fast */
  27 static inline void mdm_readline(char *buf, int bufsiz)
  28 {
  29         char c;
  30         char *p;
  31         int n;
  32
  33         n = 0;
  34         p = buf;
  35         for(;;) {
  36                 c = serial_getc();
  37
  38                 /*              dbg("(%c)", c); */
  39
  40                 switch(c) {
  41                 case '\r':
  42                         break;
  43                 case '\n':
  44                         *p = '\0';
  45                         return;
  46
  47                 default:
  48                         if(n++ > bufsiz) {
  49                                 *p = '\0';
  50                                 return; /* sanity check */
  51                         }
  52                         *p = c;
  53                         p++;
  54                         break;
  55                 }
  56         }
  57 }
  58
  59 extern void  dbg(const char *fmt, ...);
  60 int mdm_init (void)
  61 {
  62         char env_str[16];
  63         char *init_str;
  64         int i;
  65         extern char console_buffer[];
  66         extern void enable_putc(void);
  67         extern int hwflow_onoff(int);
  68
  69         enable_putc(); /* enable serial_putc() */
  70
  71 #ifdef CONFIG_HWFLOW
  72         init_str = getenv("mdm_flow_control");
  73         if (init_str && (strcmp(init_str, "rts/cts") == 0))
  74                 hwflow_onoff (1);
  75         else
  76                 hwflow_onoff(-1);
  77 #endif
  78
  79         for (i = 1;;i++) {
  80                 sprintf(env_str, "mdm_init%d", i);
  81                 if ((init_str = getenv(env_str)) != NULL) {
  82                         serial_puts(init_str);
  83                         serial_puts("\n");
  84                         for(;;) {
  85                                 mdm_readline(console_buffer, CONFIG_SYS_CBSIZE);
  86                                 dbg("ini%d: [%s]", i, console_buffer);
  87
  88                                 if ((strcmp(console_buffer, "OK") == 0) ||
  89                                         (strcmp(console_buffer, "ERROR") == 0)) {
  90                                         dbg("ini%d: cmd done", i);
  91                                         break;
  92                                 } else /* in case we are originating call ... */
  93                                         if (strncmp(console_buffer, "CONNECT", 7) == 0) {
  94                                                 dbg("ini%d: connect", i);
  95                                                 return 0;
  96                                         }
  97                         }
  98                 } else
  99                         break; /* no init string - stop modem init */
 100
 101                 udelay(100000);
 102         }
 103
 104         udelay(100000);
 105
 106         /* final stage - wait for connect */
 107         for(;i > 1;) { /* if 'i' > 1 - wait for connection
 108                                   message from modem */
 109                 mdm_readline(console_buffer, CONFIG_SYS_CBSIZE);
 110                 dbg("ini_f: [%s]", console_buffer);
 111                 if (strncmp(console_buffer, "CONNECT", 7) == 0) {
 112                         dbg("ini_f: connected");
 113                         return 0;
 114                 }
 115         }
 116
 117         return 0;
 118 }