summaryrefslogtreecommitdiff
path: root/packages/linux/linux-openmoko-devel/fix-gta01-flowcontrol2-2.6.23.patch
blob: deb31dacd945d3949b3facab4bba6c210f2c6849 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
--- linux-2.6.23/arch/arm/common/gta01_pm_gsm.c.orig	2007-10-30 23:29:53.000000000 -0500
+++ linux-2.6.23/arch/arm/common/gta01_pm_gsm.c	2007-10-30 23:35:44.000000000 -0500
@@ -23,6 +23,9 @@
 #include <asm/arch/gta01.h>
 #include <asm/arch/gta02.h>
 
+#include <linux/serial_core.h>
+void s3c24xx_set_flow_control(struct uart_port *port, int fc_on);
+
 struct gta01pm_priv {
 	int gpio_ngsm_en;
 	struct console *con;
@@ -49,6 +52,23 @@
 static ssize_t gsm_read(struct device *dev, struct device_attribute *attr,
 			char *buf)
 {
+	struct uart_driver *udrive = NULL;
+	struct uart_state *ustate = NULL;
+	struct uart_port *uport = NULL;
+
+	if (gta01_gsm.con) {
+		udrive = gta01_gsm.con->data;
+		if (udrive) {
+			ustate = udrive->state;
+			if (ustate) {
+				uport = ustate->port;
+			}
+		}
+	}
+	printk("gsm: gsm_read of \"%s\"\n", attr->attr.name);
+	printk("gsm: con=%p udrive=%p ustate=%p uport=%p\n",
+	       gta01_gsm.con, udrive, ustate, uport);
+
 	if (!strcmp(attr->attr.name, "power_on")) {
 		if (s3c2410_gpio_getpin(GTA01_GPIO_MODEM_ON))
 			goto out_1;
@@ -58,6 +78,24 @@
 	} else if (!strcmp(attr->attr.name, "download")) {
 		if (s3c2410_gpio_getpin(GTA01_GPIO_MODEM_DNLOAD))
 			goto out_1;
+	} else if (!strcmp(attr->attr.name, "flowcontrol")) {
+		if (uport) {
+			if (uport->unused[2] & 0x2) {
+				if (uport->unused[2] & 0x1) {
+					printk("gsm: flow control allowed and on\n");
+					goto out_1;
+				} else {
+					printk("gsm: flow control allowed and not on\n");
+				}
+			} else {
+				if (uport->unused[2] & 0x1)
+					printk("gsm: flow control not allowed, "
+					       "but is pending\n");
+				else
+					printk("gsm: flow control not allowed, "
+					       "not pending\n");
+			}
+		}
 	}
 
 	return strlcpy(buf, "0\n", 3);
@@ -68,10 +106,26 @@
 static ssize_t gsm_write(struct device *dev, struct device_attribute *attr,
 			 const char *buf, size_t count)
 {
+	struct uart_driver *udrive = NULL;
+	struct uart_state *ustate = NULL;
+	struct uart_port *uport = NULL;
+	static int was_on = 0;
 	unsigned long on = simple_strtoul(buf, NULL, 10);
 
+	if (gta01_gsm.con) {
+		udrive = gta01_gsm.con->data;
+		if (udrive) {
+			ustate = udrive->state;
+			if (ustate) {
+				uport = ustate->port;
+			}
+		}
+	}
+	printk("gsm: con=%p udrive=%p ustate=%p uport=%p\n",
+	       gta01_gsm.con, udrive, ustate, uport);
+
 	if (!strcmp(attr->attr.name, "power_on")) {
-		if (on) {
+		if (on && !was_on) {
 			if (gta01_gsm.con) {
 				dev_info(dev, "powering up GSM, thus "
 					 "disconnecting serial console\n");
@@ -83,7 +137,24 @@
 				s3c2410_gpio_setpin(gta01_gsm.gpio_ngsm_en, 0);
 
 			s3c2410_gpio_setpin(GTA01_GPIO_MODEM_ON, 1);
-		} else {
+
+			if (uport) {
+				/* set any pending flow-control mode */
+				uport->unused[2] |= 0x2;
+				s3c24xx_set_flow_control(uport,
+							 (uport->unused[2] & 0x1));
+				dev_info(dev, "flow control allowed\n");
+			}
+
+			was_on = 1;
+
+		} else if (!on && was_on) {
+			if (uport) {
+				uport->unused[2] &= ~0x2;
+				s3c24xx_set_flow_control(uport, 0);
+				dev_info(dev, "flow control not allowed\n");
+			}
+
 			s3c2410_gpio_setpin(GTA01_GPIO_MODEM_ON, 0);
 
 			if (gta01_gsm.gpio_ngsm_en)
@@ -95,6 +166,8 @@
 				dev_info(dev, "powered down GSM, thus enabling "
 					 "serial console\n");
 			}
+
+			was_on = 0;
 		}
 	} else if (!strcmp(attr->attr.name, "reset")) {
 		s3c2410_gpio_setpin(GTA01_GPIO_MODEM_RST, on);
@@ -105,6 +178,7 @@
 	return count;
 }
 
+static DEVICE_ATTR(flowcontrol, 0644, gsm_read, gsm_write);
 static DEVICE_ATTR(power_on, 0644, gsm_read, gsm_write);
 static DEVICE_ATTR(reset, 0644, gsm_read, gsm_write);
 static DEVICE_ATTR(download, 0644, gsm_read, gsm_write);
@@ -136,6 +210,7 @@
 #endif
 
 static struct attribute *gta01_gsm_sysfs_entries[] = {
+	&dev_attr_flowcontrol.attr,
 	&dev_attr_power_on.attr,
 	&dev_attr_reset.attr,
 	NULL,
--- linux-2.6.23/drivers/serial/s3c2410.c.orig	2007-10-30 23:31:59.000000000 -0500
+++ linux-2.6.23/drivers/serial/s3c2410.c	2007-10-30 23:35:44.000000000 -0500
@@ -80,6 +80,8 @@
 
 #include <asm/plat-s3c/regs-serial.h>
 #include <asm/arch/regs-gpio.h>
+#include <asm/mach-types.h>
+#include <asm/arch/gta01.h>
 
 /* structures */
 
@@ -729,6 +731,17 @@
 	return best->quot;
 }
 
+/* This routine is called whenever the gta01 modem/console switches */
+void s3c24xx_set_flow_control(struct uart_port *port, int fc_on)
+{
+	unsigned int umcon;
+	if (machine_is_neo1973_gta01() && port) {
+		umcon = (fc_on) ? S3C2410_UMCOM_AFC : 0;
+		wr_regl(port, S3C2410_UMCON, umcon);
+	}
+}
+EXPORT_SYMBOL(s3c24xx_set_flow_control);
+
 static void s3c24xx_serial_set_termios(struct uart_port *port,
 				       struct ktermios *termios,
 				       struct ktermios *old)
@@ -803,6 +816,23 @@
 
 	umcon = (termios->c_cflag & CRTSCTS) ? S3C2410_UMCOM_AFC : 0;
 
+        /*
+	 * Custom handling of flow control on hwport 0 for the GTA01:
+	 *  Save the desired state for flow control, but if the port
+	 *  is being used as a console, then do not actually enable
+	 *  flow control unless the flag permiting us to do so is set.
+	 */
+	if (machine_is_neo1973_gta01() && (cfg->hwport == 0)) {
+		if (umcon)
+			port->unused[2] |= 0x1;
+		else
+			port->unused[2] &= ~0x1;
+		if (port->cons && (port->cons->index >= 0)) {
+			if (!(port->unused[2] & 0x2))
+				umcon = 0;
+		}
+	}
+
 	if (termios->c_cflag & PARENB) {
 		if (termios->c_cflag & PARODD)
 			ulcon |= S3C2410_LCON_PODD;