]> git.sur5r.net Git - u-boot/blob - common/modem.c
fsl_pci_init_port end-point initialization is broken
[u-boot] / 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 }