Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 1 | /* |
| 2 | * vio driver interface to hvc_console.c |
| 3 | * |
Lucas De Marchi | 25985ed | 2011-03-30 22:57:33 -0300 | [diff] [blame] | 4 | * This code was moved here to allow the remaining code to be reused as a |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 5 | * generic polling mode with semi-reliable transport driver core to the |
| 6 | * console and tty subsystems. |
| 7 | * |
| 8 | * |
| 9 | * Copyright (C) 2001 Anton Blanchard <anton@au.ibm.com>, IBM |
| 10 | * Copyright (C) 2001 Paul Mackerras <paulus@au.ibm.com>, IBM |
| 11 | * Copyright (C) 2004 Benjamin Herrenschmidt <benh@kernel.crashing.org>, IBM Corp. |
| 12 | * Copyright (C) 2004 IBM Corporation |
| 13 | * |
| 14 | * Additional Author(s): |
| 15 | * Ryan S. Arnold <rsa@us.ibm.com> |
| 16 | * |
| 17 | * This program is free software; you can redistribute it and/or modify |
| 18 | * it under the terms of the GNU General Public License as published by |
| 19 | * the Free Software Foundation; either version 2 of the License, or |
| 20 | * (at your option) any later version. |
| 21 | * |
| 22 | * This program is distributed in the hope that it will be useful, |
| 23 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 24 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 25 | * GNU General Public License for more details. |
| 26 | * |
| 27 | * You should have received a copy of the GNU General Public License |
| 28 | * along with this program; if not, write to the Free Software |
| 29 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 30 | * |
| 31 | * TODO: |
| 32 | * |
| 33 | * - handle error in sending hvsi protocol packets |
| 34 | * - retry nego on subsequent sends ? |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 35 | */ |
| 36 | |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 37 | #undef DEBUG |
| 38 | |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 39 | #include <linux/types.h> |
| 40 | #include <linux/init.h> |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 41 | #include <linux/delay.h> |
| 42 | #include <linux/slab.h> |
| 43 | #include <linux/console.h> |
Paul Gortmaker | 578b9ce | 2011-05-27 16:14:23 -0400 | [diff] [blame] | 44 | #include <linux/module.h> |
Ryan S. Arnold | 45d607e | 2006-03-27 21:25:16 +0200 | [diff] [blame] | 45 | |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 46 | #include <asm/hvconsole.h> |
| 47 | #include <asm/vio.h> |
| 48 | #include <asm/prom.h> |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 49 | #include <asm/hvsi.h> |
| 50 | #include <asm/udbg.h> |
Ben Hutchings | 1926d0a | 2013-09-01 17:24:16 +0100 | [diff] [blame] | 51 | #include <asm/machdep.h> |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 52 | |
Ryan S. Arnold | 45d607e | 2006-03-27 21:25:16 +0200 | [diff] [blame] | 53 | #include "hvc_console.h" |
| 54 | |
Joe Perches | 5a71c61 | 2010-09-13 09:47:42 +0000 | [diff] [blame] | 55 | static const char hvc_driver_name[] = "hvc_console"; |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 56 | |
Bill Pemberton | de88b34 | 2012-11-19 13:24:32 -0500 | [diff] [blame] | 57 | static struct vio_device_id hvc_driver_table[] = { |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 58 | {"serial", "hvterm1"}, |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 59 | #ifndef HVC_OLD_HVSI |
| 60 | {"serial", "hvterm-protocol"}, |
| 61 | #endif |
Stephen Rothwell | fb120da | 2005-08-17 16:42:59 +1000 | [diff] [blame] | 62 | { "", "" } |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 63 | }; |
| 64 | MODULE_DEVICE_TABLE(vio, hvc_driver_table); |
| 65 | |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 66 | typedef enum hv_protocol { |
| 67 | HV_PROTOCOL_RAW, |
| 68 | HV_PROTOCOL_HVSI |
| 69 | } hv_protocol_t; |
| 70 | |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 71 | struct hvterm_priv { |
Benjamin Herrenschmidt | 17bdc6c | 2011-04-29 16:44:24 +1000 | [diff] [blame] | 72 | u32 termno; /* HV term number */ |
| 73 | hv_protocol_t proto; /* Raw data or HVSI packets */ |
| 74 | struct hvsi_priv hvsi; /* HVSI specific data */ |
Anton Blanchard | 19df9ab | 2011-07-12 19:19:57 +0000 | [diff] [blame] | 75 | spinlock_t buf_lock; |
| 76 | char buf[SIZE_VIO_GET_CHARS]; |
| 77 | int left; |
| 78 | int offset; |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 79 | }; |
| 80 | static struct hvterm_priv *hvterm_privs[MAX_NR_HVC_CONSOLES]; |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 81 | /* For early boot console */ |
| 82 | static struct hvterm_priv hvterm_priv0; |
| 83 | |
| 84 | static int hvterm_raw_get_chars(uint32_t vtermno, char *buf, int count) |
Milton Miller | 70b234a | 2005-07-07 17:56:26 -0700 | [diff] [blame] | 85 | { |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 86 | struct hvterm_priv *pv = hvterm_privs[vtermno]; |
Anton Blanchard | 19df9ab | 2011-07-12 19:19:57 +0000 | [diff] [blame] | 87 | unsigned long i; |
| 88 | unsigned long flags; |
| 89 | int got; |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 90 | |
| 91 | if (WARN_ON(!pv)) |
| 92 | return 0; |
Milton Miller | 70b234a | 2005-07-07 17:56:26 -0700 | [diff] [blame] | 93 | |
Anton Blanchard | 19df9ab | 2011-07-12 19:19:57 +0000 | [diff] [blame] | 94 | spin_lock_irqsave(&pv->buf_lock, flags); |
Ryan S. Arnold | 45d607e | 2006-03-27 21:25:16 +0200 | [diff] [blame] | 95 | |
Anton Blanchard | 19df9ab | 2011-07-12 19:19:57 +0000 | [diff] [blame] | 96 | if (pv->left == 0) { |
| 97 | pv->offset = 0; |
| 98 | pv->left = hvc_get_chars(pv->termno, pv->buf, count); |
Milton Miller | 70b234a | 2005-07-07 17:56:26 -0700 | [diff] [blame] | 99 | |
Anton Blanchard | 19df9ab | 2011-07-12 19:19:57 +0000 | [diff] [blame] | 100 | /* |
| 101 | * Work around a HV bug where it gives us a null |
| 102 | * after every \r. -- paulus |
| 103 | */ |
| 104 | for (i = 1; i < pv->left; ++i) { |
| 105 | if (pv->buf[i] == 0 && pv->buf[i-1] == '\r') { |
| 106 | --pv->left; |
| 107 | if (i < pv->left) { |
| 108 | memmove(&pv->buf[i], &pv->buf[i+1], |
| 109 | pv->left - i); |
| 110 | } |
| 111 | } |
Milton Miller | 70b234a | 2005-07-07 17:56:26 -0700 | [diff] [blame] | 112 | } |
| 113 | } |
Anton Blanchard | 19df9ab | 2011-07-12 19:19:57 +0000 | [diff] [blame] | 114 | |
| 115 | got = min(count, pv->left); |
| 116 | memcpy(buf, &pv->buf[pv->offset], got); |
| 117 | pv->offset += got; |
| 118 | pv->left -= got; |
| 119 | |
| 120 | spin_unlock_irqrestore(&pv->buf_lock, flags); |
| 121 | |
Milton Miller | 70b234a | 2005-07-07 17:56:26 -0700 | [diff] [blame] | 122 | return got; |
| 123 | } |
| 124 | |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 125 | static int hvterm_raw_put_chars(uint32_t vtermno, const char *buf, int count) |
| 126 | { |
| 127 | struct hvterm_priv *pv = hvterm_privs[vtermno]; |
| 128 | |
| 129 | if (WARN_ON(!pv)) |
| 130 | return 0; |
| 131 | |
| 132 | return hvc_put_chars(pv->termno, buf, count); |
| 133 | } |
| 134 | |
| 135 | static const struct hv_ops hvterm_raw_ops = { |
| 136 | .get_chars = hvterm_raw_get_chars, |
| 137 | .put_chars = hvterm_raw_put_chars, |
Christian Borntraeger | 611e097 | 2008-06-20 15:24:08 +0200 | [diff] [blame] | 138 | .notifier_add = notifier_add_irq, |
| 139 | .notifier_del = notifier_del_irq, |
Hendrik Brueckner | fc362e2 | 2008-10-13 23:12:48 +0000 | [diff] [blame] | 140 | .notifier_hangup = notifier_hangup_irq, |
Milton Miller | 030ffad | 2005-07-07 17:56:25 -0700 | [diff] [blame] | 141 | }; |
| 142 | |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 143 | static int hvterm_hvsi_get_chars(uint32_t vtermno, char *buf, int count) |
| 144 | { |
| 145 | struct hvterm_priv *pv = hvterm_privs[vtermno]; |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 146 | |
| 147 | if (WARN_ON(!pv)) |
| 148 | return 0; |
| 149 | |
Benjamin Herrenschmidt | 87fa35d | 2011-07-01 13:10:21 +1000 | [diff] [blame] | 150 | return hvsilib_get_chars(&pv->hvsi, buf, count); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 151 | } |
| 152 | |
| 153 | static int hvterm_hvsi_put_chars(uint32_t vtermno, const char *buf, int count) |
| 154 | { |
| 155 | struct hvterm_priv *pv = hvterm_privs[vtermno]; |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 156 | |
| 157 | if (WARN_ON(!pv)) |
| 158 | return 0; |
| 159 | |
Benjamin Herrenschmidt | 87fa35d | 2011-07-01 13:10:21 +1000 | [diff] [blame] | 160 | return hvsilib_put_chars(&pv->hvsi, buf, count); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 161 | } |
| 162 | |
| 163 | static int hvterm_hvsi_open(struct hvc_struct *hp, int data) |
| 164 | { |
| 165 | struct hvterm_priv *pv = hvterm_privs[hp->vtermno]; |
| 166 | int rc; |
| 167 | |
| 168 | pr_devel("HVSI@%x: open !\n", pv->termno); |
| 169 | |
| 170 | rc = notifier_add_irq(hp, data); |
| 171 | if (rc) |
| 172 | return rc; |
| 173 | |
Benjamin Herrenschmidt | 87fa35d | 2011-07-01 13:10:21 +1000 | [diff] [blame] | 174 | return hvsilib_open(&pv->hvsi, hp); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 175 | } |
| 176 | |
| 177 | static void hvterm_hvsi_close(struct hvc_struct *hp, int data) |
| 178 | { |
| 179 | struct hvterm_priv *pv = hvterm_privs[hp->vtermno]; |
| 180 | |
Benjamin Herrenschmidt | 17bdc6c | 2011-04-29 16:44:24 +1000 | [diff] [blame] | 181 | pr_devel("HVSI@%x: do close !\n", pv->termno); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 182 | |
Benjamin Herrenschmidt | 87fa35d | 2011-07-01 13:10:21 +1000 | [diff] [blame] | 183 | hvsilib_close(&pv->hvsi, hp); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 184 | |
| 185 | notifier_del_irq(hp, data); |
| 186 | } |
| 187 | |
| 188 | void hvterm_hvsi_hangup(struct hvc_struct *hp, int data) |
| 189 | { |
| 190 | struct hvterm_priv *pv = hvterm_privs[hp->vtermno]; |
| 191 | |
Benjamin Herrenschmidt | 17bdc6c | 2011-04-29 16:44:24 +1000 | [diff] [blame] | 192 | pr_devel("HVSI@%x: do hangup !\n", pv->termno); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 193 | |
Benjamin Herrenschmidt | 87fa35d | 2011-07-01 13:10:21 +1000 | [diff] [blame] | 194 | hvsilib_close(&pv->hvsi, hp); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 195 | |
| 196 | notifier_hangup_irq(hp, data); |
| 197 | } |
| 198 | |
| 199 | static int hvterm_hvsi_tiocmget(struct hvc_struct *hp) |
| 200 | { |
| 201 | struct hvterm_priv *pv = hvterm_privs[hp->vtermno]; |
| 202 | |
| 203 | if (!pv) |
| 204 | return -EINVAL; |
Benjamin Herrenschmidt | 17bdc6c | 2011-04-29 16:44:24 +1000 | [diff] [blame] | 205 | return pv->hvsi.mctrl; |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 206 | } |
| 207 | |
| 208 | static int hvterm_hvsi_tiocmset(struct hvc_struct *hp, unsigned int set, |
| 209 | unsigned int clear) |
| 210 | { |
| 211 | struct hvterm_priv *pv = hvterm_privs[hp->vtermno]; |
| 212 | |
| 213 | pr_devel("HVSI@%x: Set modem control, set=%x,clr=%x\n", |
| 214 | pv->termno, set, clear); |
| 215 | |
| 216 | if (set & TIOCM_DTR) |
Benjamin Herrenschmidt | 87fa35d | 2011-07-01 13:10:21 +1000 | [diff] [blame] | 217 | hvsilib_write_mctrl(&pv->hvsi, 1); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 218 | else if (clear & TIOCM_DTR) |
Benjamin Herrenschmidt | 87fa35d | 2011-07-01 13:10:21 +1000 | [diff] [blame] | 219 | hvsilib_write_mctrl(&pv->hvsi, 0); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 220 | |
| 221 | return 0; |
| 222 | } |
| 223 | |
| 224 | static const struct hv_ops hvterm_hvsi_ops = { |
| 225 | .get_chars = hvterm_hvsi_get_chars, |
| 226 | .put_chars = hvterm_hvsi_put_chars, |
| 227 | .notifier_add = hvterm_hvsi_open, |
| 228 | .notifier_del = hvterm_hvsi_close, |
| 229 | .notifier_hangup = hvterm_hvsi_hangup, |
| 230 | .tiocmget = hvterm_hvsi_tiocmget, |
| 231 | .tiocmset = hvterm_hvsi_tiocmset, |
| 232 | }; |
| 233 | |
Benjamin Herrenschmidt | d1cfc0c | 2012-07-23 21:47:38 +0000 | [diff] [blame] | 234 | static void udbg_hvc_putc(char c) |
| 235 | { |
| 236 | int count = -1; |
| 237 | |
| 238 | if (!hvterm_privs[0]) |
| 239 | return; |
| 240 | |
| 241 | if (c == '\n') |
| 242 | udbg_hvc_putc('\r'); |
| 243 | |
| 244 | do { |
| 245 | switch(hvterm_privs[0]->proto) { |
| 246 | case HV_PROTOCOL_RAW: |
| 247 | count = hvterm_raw_put_chars(0, &c, 1); |
| 248 | break; |
| 249 | case HV_PROTOCOL_HVSI: |
| 250 | count = hvterm_hvsi_put_chars(0, &c, 1); |
| 251 | break; |
| 252 | } |
| 253 | } while(count == 0); |
| 254 | } |
| 255 | |
| 256 | static int udbg_hvc_getc_poll(void) |
| 257 | { |
| 258 | int rc = 0; |
| 259 | char c; |
| 260 | |
| 261 | if (!hvterm_privs[0]) |
| 262 | return -1; |
| 263 | |
| 264 | switch(hvterm_privs[0]->proto) { |
| 265 | case HV_PROTOCOL_RAW: |
| 266 | rc = hvterm_raw_get_chars(0, &c, 1); |
| 267 | break; |
| 268 | case HV_PROTOCOL_HVSI: |
| 269 | rc = hvterm_hvsi_get_chars(0, &c, 1); |
| 270 | break; |
| 271 | } |
| 272 | if (!rc) |
| 273 | return -1; |
| 274 | return c; |
| 275 | } |
| 276 | |
| 277 | static int udbg_hvc_getc(void) |
| 278 | { |
| 279 | int ch; |
| 280 | |
| 281 | if (!hvterm_privs[0]) |
| 282 | return -1; |
| 283 | |
| 284 | for (;;) { |
| 285 | ch = udbg_hvc_getc_poll(); |
| 286 | if (ch == -1) { |
| 287 | /* This shouldn't be needed...but... */ |
| 288 | volatile unsigned long delay; |
| 289 | for (delay=0; delay < 2000000; delay++) |
| 290 | ; |
| 291 | } else { |
| 292 | return ch; |
| 293 | } |
| 294 | } |
| 295 | } |
| 296 | |
Bill Pemberton | 9671f09 | 2012-11-19 13:21:50 -0500 | [diff] [blame] | 297 | static int hvc_vio_probe(struct vio_dev *vdev, |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 298 | const struct vio_device_id *id) |
| 299 | { |
| 300 | const struct hv_ops *ops; |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 301 | struct hvc_struct *hp; |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 302 | struct hvterm_priv *pv; |
| 303 | hv_protocol_t proto; |
| 304 | int i, termno = -1; |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 305 | |
| 306 | /* probed with invalid parameters. */ |
| 307 | if (!vdev || !id) |
| 308 | return -EPERM; |
| 309 | |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 310 | if (of_device_is_compatible(vdev->dev.of_node, "hvterm1")) { |
| 311 | proto = HV_PROTOCOL_RAW; |
| 312 | ops = &hvterm_raw_ops; |
| 313 | } else if (of_device_is_compatible(vdev->dev.of_node, "hvterm-protocol")) { |
| 314 | proto = HV_PROTOCOL_HVSI; |
| 315 | ops = &hvterm_hvsi_ops; |
| 316 | } else { |
Masanari Iida | 46e99c4 | 2012-10-24 23:29:41 +0900 | [diff] [blame] | 317 | pr_err("hvc_vio: Unknown protocol for %s\n", vdev->dev.of_node->full_name); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 318 | return -ENXIO; |
| 319 | } |
| 320 | |
| 321 | pr_devel("hvc_vio_probe() device %s, using %s protocol\n", |
| 322 | vdev->dev.of_node->full_name, |
| 323 | proto == HV_PROTOCOL_RAW ? "raw" : "hvsi"); |
| 324 | |
| 325 | /* Is it our boot one ? */ |
| 326 | if (hvterm_privs[0] == &hvterm_priv0 && |
| 327 | vdev->unit_address == hvterm_priv0.termno) { |
| 328 | pv = hvterm_privs[0]; |
| 329 | termno = 0; |
| 330 | pr_devel("->boot console, using termno 0\n"); |
| 331 | } |
| 332 | /* nope, allocate a new one */ |
| 333 | else { |
| 334 | for (i = 0; i < MAX_NR_HVC_CONSOLES && termno < 0; i++) |
| 335 | if (!hvterm_privs[i]) |
| 336 | termno = i; |
| 337 | pr_devel("->non-boot console, using termno %d\n", termno); |
| 338 | if (termno < 0) |
| 339 | return -ENODEV; |
| 340 | pv = kzalloc(sizeof(struct hvterm_priv), GFP_KERNEL); |
| 341 | if (!pv) |
| 342 | return -ENOMEM; |
| 343 | pv->termno = vdev->unit_address; |
| 344 | pv->proto = proto; |
Anton Blanchard | 19df9ab | 2011-07-12 19:19:57 +0000 | [diff] [blame] | 345 | spin_lock_init(&pv->buf_lock); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 346 | hvterm_privs[termno] = pv; |
Benjamin Herrenschmidt | 87fa35d | 2011-07-01 13:10:21 +1000 | [diff] [blame] | 347 | hvsilib_init(&pv->hvsi, hvc_get_chars, hvc_put_chars, |
| 348 | pv->termno, 0); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 349 | } |
| 350 | |
| 351 | hp = hvc_alloc(termno, vdev->irq, ops, MAX_VIO_PUT_CHARS); |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 352 | if (IS_ERR(hp)) |
| 353 | return PTR_ERR(hp); |
| 354 | dev_set_drvdata(&vdev->dev, hp); |
| 355 | |
Benjamin Herrenschmidt | d1cfc0c | 2012-07-23 21:47:38 +0000 | [diff] [blame] | 356 | /* register udbg if it's not there already for console 0 */ |
| 357 | if (hp->index == 0 && !udbg_putc) { |
| 358 | udbg_putc = udbg_hvc_putc; |
| 359 | udbg_getc = udbg_hvc_getc; |
| 360 | udbg_getc_poll = udbg_hvc_getc_poll; |
| 361 | } |
| 362 | |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 363 | return 0; |
| 364 | } |
| 365 | |
Bill Pemberton | ae8d8a1 | 2012-11-19 13:26:18 -0500 | [diff] [blame] | 366 | static int hvc_vio_remove(struct vio_dev *vdev) |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 367 | { |
| 368 | struct hvc_struct *hp = dev_get_drvdata(&vdev->dev); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 369 | int rc, termno; |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 370 | |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 371 | termno = hp->vtermno; |
| 372 | rc = hvc_remove(hp); |
| 373 | if (rc == 0) { |
| 374 | if (hvterm_privs[termno] != &hvterm_priv0) |
| 375 | kfree(hvterm_privs[termno]); |
| 376 | hvterm_privs[termno] = NULL; |
| 377 | } |
| 378 | return rc; |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 379 | } |
| 380 | |
| 381 | static struct vio_driver hvc_vio_driver = { |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 382 | .id_table = hvc_driver_table, |
| 383 | .probe = hvc_vio_probe, |
Benjamin Herrenschmidt | cb52d89 | 2012-03-26 19:06:30 +0000 | [diff] [blame] | 384 | .remove = hvc_vio_remove, |
| 385 | .name = hvc_driver_name, |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 386 | }; |
| 387 | |
Peter Huewe | 948c28f | 2009-08-20 11:14:06 +0000 | [diff] [blame] | 388 | static int __init hvc_vio_init(void) |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 389 | { |
| 390 | int rc; |
| 391 | |
| 392 | /* Register as a vio device to receive callbacks */ |
| 393 | rc = vio_register_driver(&hvc_vio_driver); |
| 394 | |
| 395 | return rc; |
| 396 | } |
| 397 | module_init(hvc_vio_init); /* after drivers/char/hvc_console.c */ |
| 398 | |
Peter Huewe | 948c28f | 2009-08-20 11:14:06 +0000 | [diff] [blame] | 399 | static void __exit hvc_vio_exit(void) |
Milton Miller | acad955 | 2005-07-07 17:56:24 -0700 | [diff] [blame] | 400 | { |
| 401 | vio_unregister_driver(&hvc_vio_driver); |
| 402 | } |
| 403 | module_exit(hvc_vio_exit); |
| 404 | |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 405 | void __init hvc_vio_init_early(void) |
| 406 | { |
Anton Blanchard | 1502b48 | 2013-08-07 02:01:39 +1000 | [diff] [blame] | 407 | const __be32 *termno; |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 408 | const char *name; |
| 409 | const struct hv_ops *ops; |
| 410 | |
| 411 | /* find the boot console from /chosen/stdout */ |
Grant Likely | a752ee5 | 2014-03-28 08:12:18 -0700 | [diff] [blame] | 412 | if (!of_stdout) |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 413 | return; |
Grant Likely | a752ee5 | 2014-03-28 08:12:18 -0700 | [diff] [blame] | 414 | name = of_get_property(of_stdout, "name", NULL); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 415 | if (!name) { |
| 416 | printk(KERN_WARNING "stdout node missing 'name' property!\n"); |
Grant Likely | a752ee5 | 2014-03-28 08:12:18 -0700 | [diff] [blame] | 417 | return; |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 418 | } |
| 419 | |
| 420 | /* Check if it's a virtual terminal */ |
| 421 | if (strncmp(name, "vty", 3) != 0) |
Grant Likely | a752ee5 | 2014-03-28 08:12:18 -0700 | [diff] [blame] | 422 | return; |
| 423 | termno = of_get_property(of_stdout, "reg", NULL); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 424 | if (termno == NULL) |
Grant Likely | a752ee5 | 2014-03-28 08:12:18 -0700 | [diff] [blame] | 425 | return; |
Anton Blanchard | 1502b48 | 2013-08-07 02:01:39 +1000 | [diff] [blame] | 426 | hvterm_priv0.termno = of_read_number(termno, 1); |
Anton Blanchard | 19df9ab | 2011-07-12 19:19:57 +0000 | [diff] [blame] | 427 | spin_lock_init(&hvterm_priv0.buf_lock); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 428 | hvterm_privs[0] = &hvterm_priv0; |
| 429 | |
| 430 | /* Check the protocol */ |
Grant Likely | a752ee5 | 2014-03-28 08:12:18 -0700 | [diff] [blame] | 431 | if (of_device_is_compatible(of_stdout, "hvterm1")) { |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 432 | hvterm_priv0.proto = HV_PROTOCOL_RAW; |
| 433 | ops = &hvterm_raw_ops; |
| 434 | } |
Grant Likely | a752ee5 | 2014-03-28 08:12:18 -0700 | [diff] [blame] | 435 | else if (of_device_is_compatible(of_stdout, "hvterm-protocol")) { |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 436 | hvterm_priv0.proto = HV_PROTOCOL_HVSI; |
| 437 | ops = &hvterm_hvsi_ops; |
Benjamin Herrenschmidt | 87fa35d | 2011-07-01 13:10:21 +1000 | [diff] [blame] | 438 | hvsilib_init(&hvterm_priv0.hvsi, hvc_get_chars, hvc_put_chars, |
| 439 | hvterm_priv0.termno, 1); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 440 | /* HVSI, perform the handshake now */ |
Benjamin Herrenschmidt | 87fa35d | 2011-07-01 13:10:21 +1000 | [diff] [blame] | 441 | hvsilib_establish(&hvterm_priv0.hvsi); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 442 | } else |
Grant Likely | a752ee5 | 2014-03-28 08:12:18 -0700 | [diff] [blame] | 443 | return; |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 444 | udbg_putc = udbg_hvc_putc; |
| 445 | udbg_getc = udbg_hvc_getc; |
| 446 | udbg_getc_poll = udbg_hvc_getc_poll; |
| 447 | #ifdef HVC_OLD_HVSI |
| 448 | /* When using the old HVSI driver don't register the HVC |
| 449 | * backend for HVSI, only do udbg |
| 450 | */ |
| 451 | if (hvterm_priv0.proto == HV_PROTOCOL_HVSI) |
Grant Likely | a752ee5 | 2014-03-28 08:12:18 -0700 | [diff] [blame] | 452 | return; |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 453 | #endif |
Ben Hutchings | 1926d0a | 2013-09-01 17:24:16 +0100 | [diff] [blame] | 454 | /* Check whether the user has requested a different console. */ |
Anton Blanchard | 3e47d14 | 2014-09-17 14:39:36 +1000 | [diff] [blame] | 455 | if (!strstr(boot_command_line, "console=")) |
Ben Hutchings | 1926d0a | 2013-09-01 17:24:16 +0100 | [diff] [blame] | 456 | add_preferred_console("hvc", 0, NULL); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 457 | hvc_instantiate(0, 0, ops); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 458 | } |
| 459 | |
| 460 | /* call this from early_init() for a working debug console on |
| 461 | * vterm capable LPAR machines |
| 462 | */ |
| 463 | #ifdef CONFIG_PPC_EARLY_DEBUG_LPAR |
| 464 | void __init udbg_init_debug_lpar(void) |
| 465 | { |
| 466 | hvterm_privs[0] = &hvterm_priv0; |
| 467 | hvterm_priv0.termno = 0; |
| 468 | hvterm_priv0.proto = HV_PROTOCOL_RAW; |
Benjamin Herrenschmidt | f7723f0 | 2011-07-20 18:01:48 +1000 | [diff] [blame] | 469 | spin_lock_init(&hvterm_priv0.buf_lock); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 470 | udbg_putc = udbg_hvc_putc; |
| 471 | udbg_getc = udbg_hvc_getc; |
| 472 | udbg_getc_poll = udbg_hvc_getc_poll; |
| 473 | } |
| 474 | #endif /* CONFIG_PPC_EARLY_DEBUG_LPAR */ |
| 475 | |
| 476 | #ifdef CONFIG_PPC_EARLY_DEBUG_LPAR_HVSI |
| 477 | void __init udbg_init_debug_lpar_hvsi(void) |
| 478 | { |
| 479 | hvterm_privs[0] = &hvterm_priv0; |
| 480 | hvterm_priv0.termno = CONFIG_PPC_EARLY_DEBUG_HVSI_VTERMNO; |
| 481 | hvterm_priv0.proto = HV_PROTOCOL_HVSI; |
Benjamin Herrenschmidt | f7723f0 | 2011-07-20 18:01:48 +1000 | [diff] [blame] | 482 | spin_lock_init(&hvterm_priv0.buf_lock); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 483 | udbg_putc = udbg_hvc_putc; |
| 484 | udbg_getc = udbg_hvc_getc; |
| 485 | udbg_getc_poll = udbg_hvc_getc_poll; |
Benjamin Herrenschmidt | 87fa35d | 2011-07-01 13:10:21 +1000 | [diff] [blame] | 486 | hvsilib_init(&hvterm_priv0.hvsi, hvc_get_chars, hvc_put_chars, |
| 487 | hvterm_priv0.termno, 1); |
| 488 | hvsilib_establish(&hvterm_priv0.hvsi); |
Benjamin Herrenschmidt | 4d2bb3f | 2011-05-12 13:46:38 +1000 | [diff] [blame] | 489 | } |
| 490 | #endif /* CONFIG_PPC_EARLY_DEBUG_LPAR_HVSI */ |