hvc_vio.c revision 17bdc6c0e979ae61879806e4dd93ec3b169d0931
1acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller/* 2acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * vio driver interface to hvc_console.c 3acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * 425985edcedea6396277003854657b5f3cb31a628Lucas De Marchi * This code was moved here to allow the remaining code to be reused as a 5acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * generic polling mode with semi-reliable transport driver core to the 6acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * console and tty subsystems. 7acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * 8acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * 9acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * Copyright (C) 2001 Anton Blanchard <anton@au.ibm.com>, IBM 10acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * Copyright (C) 2001 Paul Mackerras <paulus@au.ibm.com>, IBM 11acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * Copyright (C) 2004 Benjamin Herrenschmidt <benh@kernel.crashing.org>, IBM Corp. 12acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * Copyright (C) 2004 IBM Corporation 13acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * 14acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * Additional Author(s): 15acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * Ryan S. Arnold <rsa@us.ibm.com> 16acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * 17acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * This program is free software; you can redistribute it and/or modify 18acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * it under the terms of the GNU General Public License as published by 19acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * the Free Software Foundation; either version 2 of the License, or 20acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * (at your option) any later version. 21acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * 22acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * This program is distributed in the hope that it will be useful, 23acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * but WITHOUT ANY WARRANTY; without even the implied warranty of 24acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 25acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * GNU General Public License for more details. 26acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * 27acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * You should have received a copy of the GNU General Public License 28acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * along with this program; if not, write to the Free Software 29acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 304d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt * 314d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt * TODO: 324d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt * 334d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt * - handle error in sending hvsi protocol packets 344d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt * - retry nego on subsequent sends ? 35acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller */ 36acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 374d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#undef DEBUG 384d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 39acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller#include <linux/types.h> 40acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller#include <linux/init.h> 414d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#include <linux/delay.h> 424d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#include <linux/slab.h> 434d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#include <linux/console.h> 4445d607ed92695d7543f5e1fc5b133cd69834e3e4Ryan S. Arnold 45acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller#include <asm/hvconsole.h> 46acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller#include <asm/vio.h> 47acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller#include <asm/prom.h> 48de0138da0f8cf406c096daec7494a5cbebce2e5cStephen Rothwell#include <asm/firmware.h> 494d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#include <asm/hvsi.h> 504d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#include <asm/udbg.h> 51acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 5245d607ed92695d7543f5e1fc5b133cd69834e3e4Ryan S. Arnold#include "hvc_console.h" 5345d607ed92695d7543f5e1fc5b133cd69834e3e4Ryan S. Arnold 545a71c61b7724ad0acedff254e07dc1a7dd05ee76Joe Perchesstatic const char hvc_driver_name[] = "hvc_console"; 55acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 56acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Millerstatic struct vio_device_id hvc_driver_table[] __devinitdata = { 57acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller {"serial", "hvterm1"}, 584d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#ifndef HVC_OLD_HVSI 594d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt {"serial", "hvterm-protocol"}, 604d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#endif 61fb120da678c517f72d4b39932062c2191827b331Stephen Rothwell { "", "" } 62acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller}; 63acad9559f1054487292eb10d7bb81f256e9d8f2dMilton MillerMODULE_DEVICE_TABLE(vio, hvc_driver_table); 64acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 654d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidttypedef enum hv_protocol { 664d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt HV_PROTOCOL_RAW, 674d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt HV_PROTOCOL_HVSI 684d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} hv_protocol_t; 694d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 704d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstruct hvterm_priv { 7117bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt u32 termno; /* HV term number */ 7217bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt hv_protocol_t proto; /* Raw data or HVSI packets */ 7317bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt struct hvsi_priv hvsi; /* HVSI specific data */ 744d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt}; 754d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic struct hvterm_priv *hvterm_privs[MAX_NR_HVC_CONSOLES]; 764d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 774d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt/* For early boot console */ 784d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic struct hvterm_priv hvterm_priv0; 794d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 804d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic int hvterm_raw_get_chars(uint32_t vtermno, char *buf, int count) 8170b234a40107596a713e9981c643f2717e31463fMilton Miller{ 824d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[vtermno]; 834d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt unsigned long got, i; 844d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 854d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (WARN_ON(!pv)) 864d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return 0; 8770b234a40107596a713e9981c643f2717e31463fMilton Miller 8845d607ed92695d7543f5e1fc5b133cd69834e3e4Ryan S. Arnold /* 8945d607ed92695d7543f5e1fc5b133cd69834e3e4Ryan S. Arnold * Vio firmware will read up to SIZE_VIO_GET_CHARS at its own discretion 9045d607ed92695d7543f5e1fc5b133cd69834e3e4Ryan S. Arnold * so we play safe and avoid the situation where got > count which could 9145d607ed92695d7543f5e1fc5b133cd69834e3e4Ryan S. Arnold * overload the flip buffer. 9245d607ed92695d7543f5e1fc5b133cd69834e3e4Ryan S. Arnold */ 9345d607ed92695d7543f5e1fc5b133cd69834e3e4Ryan S. Arnold if (count < SIZE_VIO_GET_CHARS) 9445d607ed92695d7543f5e1fc5b133cd69834e3e4Ryan S. Arnold return -EAGAIN; 9545d607ed92695d7543f5e1fc5b133cd69834e3e4Ryan S. Arnold 964d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt got = hvc_get_chars(pv->termno, buf, count); 9770b234a40107596a713e9981c643f2717e31463fMilton Miller 9870b234a40107596a713e9981c643f2717e31463fMilton Miller /* 9970b234a40107596a713e9981c643f2717e31463fMilton Miller * Work around a HV bug where it gives us a null 10070b234a40107596a713e9981c643f2717e31463fMilton Miller * after every \r. -- paulus 10170b234a40107596a713e9981c643f2717e31463fMilton Miller */ 10270b234a40107596a713e9981c643f2717e31463fMilton Miller for (i = 1; i < got; ++i) { 10370b234a40107596a713e9981c643f2717e31463fMilton Miller if (buf[i] == 0 && buf[i-1] == '\r') { 10470b234a40107596a713e9981c643f2717e31463fMilton Miller --got; 10570b234a40107596a713e9981c643f2717e31463fMilton Miller if (i < got) 1064d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt memmove(&buf[i], &buf[i+1], got - i); 10770b234a40107596a713e9981c643f2717e31463fMilton Miller } 10870b234a40107596a713e9981c643f2717e31463fMilton Miller } 10970b234a40107596a713e9981c643f2717e31463fMilton Miller return got; 11070b234a40107596a713e9981c643f2717e31463fMilton Miller} 11170b234a40107596a713e9981c643f2717e31463fMilton Miller 1124d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic int hvterm_raw_put_chars(uint32_t vtermno, const char *buf, int count) 1134d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 1144d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[vtermno]; 1154d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1164d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (WARN_ON(!pv)) 1174d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return 0; 1184d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1194d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return hvc_put_chars(pv->termno, buf, count); 1204d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 1214d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1224d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic const struct hv_ops hvterm_raw_ops = { 1234d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .get_chars = hvterm_raw_get_chars, 1244d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .put_chars = hvterm_raw_put_chars, 125611e097d7707741a336a0677d9d69bec40f29f3dChristian Borntraeger .notifier_add = notifier_add_irq, 126611e097d7707741a336a0677d9d69bec40f29f3dChristian Borntraeger .notifier_del = notifier_del_irq, 127fc362e2e0efd8b652ebfb409a4e43e6189c04f6fHendrik Brueckner .notifier_hangup = notifier_hangup_irq, 128030ffad23fb28fc29608a3bc21f0c3b88bf28592Milton Miller}; 129030ffad23fb28fc29608a3bc21f0c3b88bf28592Milton Miller 1304d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic int hvterm_hvsi_get_chars(uint32_t vtermno, char *buf, int count) 1314d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 1324d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[vtermno]; 1334d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1344d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (WARN_ON(!pv)) 1354d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return 0; 1364d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 13717bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt return hvsi_get_chars(&pv->hvsi, buf, count); 1384d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 1394d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1404d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic int hvterm_hvsi_put_chars(uint32_t vtermno, const char *buf, int count) 1414d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 1424d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[vtermno]; 1434d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1444d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (WARN_ON(!pv)) 1454d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return 0; 1464d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 14717bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt return hvsi_put_chars(&pv->hvsi, buf, count); 1484d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 1494d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1504d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic int hvterm_hvsi_open(struct hvc_struct *hp, int data) 1514d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 1524d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[hp->vtermno]; 1534d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt int rc; 1544d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1554d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pr_devel("HVSI@%x: open !\n", pv->termno); 1564d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1574d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt rc = notifier_add_irq(hp, data); 1584d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (rc) 1594d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return rc; 1604d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 16117bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt return hvsi_open(&pv->hvsi, hp); 1624d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 1634d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1644d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic void hvterm_hvsi_close(struct hvc_struct *hp, int data) 1654d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 1664d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[hp->vtermno]; 1674d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 16817bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt pr_devel("HVSI@%x: do close !\n", pv->termno); 1694d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 17017bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt hvsi_close(&pv->hvsi, hp); 1714d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1724d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt notifier_del_irq(hp, data); 1734d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 1744d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1754d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtvoid hvterm_hvsi_hangup(struct hvc_struct *hp, int data) 1764d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 1774d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[hp->vtermno]; 1784d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 17917bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt pr_devel("HVSI@%x: do hangup !\n", pv->termno); 1804d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 18117bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt hvsi_close(&pv->hvsi, hp); 1824d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1834d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt notifier_hangup_irq(hp, data); 1844d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 1854d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1864d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic int hvterm_hvsi_tiocmget(struct hvc_struct *hp) 1874d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 1884d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[hp->vtermno]; 1894d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1904d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (!pv) 1914d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return -EINVAL; 19217bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt return pv->hvsi.mctrl; 1934d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 1944d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1954d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic int hvterm_hvsi_tiocmset(struct hvc_struct *hp, unsigned int set, 1964d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt unsigned int clear) 1974d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 1984d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[hp->vtermno]; 1994d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 2004d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pr_devel("HVSI@%x: Set modem control, set=%x,clr=%x\n", 2014d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pv->termno, set, clear); 2024d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 2034d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (set & TIOCM_DTR) 20417bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt hvsi_write_mctrl(&pv->hvsi, 1); 2054d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt else if (clear & TIOCM_DTR) 20617bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt hvsi_write_mctrl(&pv->hvsi, 0); 2074d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 2084d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return 0; 2094d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 2104d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 2114d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic const struct hv_ops hvterm_hvsi_ops = { 2124d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .get_chars = hvterm_hvsi_get_chars, 2134d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .put_chars = hvterm_hvsi_put_chars, 2144d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .notifier_add = hvterm_hvsi_open, 2154d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .notifier_del = hvterm_hvsi_close, 2164d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .notifier_hangup = hvterm_hvsi_hangup, 2174d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .tiocmget = hvterm_hvsi_tiocmget, 2184d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .tiocmset = hvterm_hvsi_tiocmset, 2194d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt}; 2204d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 221acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Millerstatic int __devinit hvc_vio_probe(struct vio_dev *vdev, 2224d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt const struct vio_device_id *id) 223acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller{ 2244d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt const struct hv_ops *ops; 225acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller struct hvc_struct *hp; 2264d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv; 2274d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hv_protocol_t proto; 2284d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt int i, termno = -1; 229acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 230acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller /* probed with invalid parameters. */ 231acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller if (!vdev || !id) 232acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller return -EPERM; 233acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 2344d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (of_device_is_compatible(vdev->dev.of_node, "hvterm1")) { 2354d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt proto = HV_PROTOCOL_RAW; 2364d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt ops = &hvterm_raw_ops; 2374d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } else if (of_device_is_compatible(vdev->dev.of_node, "hvterm-protocol")) { 2384d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt proto = HV_PROTOCOL_HVSI; 2394d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt ops = &hvterm_hvsi_ops; 2404d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } else { 2414d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pr_err("hvc_vio: Unkown protocol for %s\n", vdev->dev.of_node->full_name); 2424d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return -ENXIO; 2434d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } 2444d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 2454d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pr_devel("hvc_vio_probe() device %s, using %s protocol\n", 2464d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt vdev->dev.of_node->full_name, 2474d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt proto == HV_PROTOCOL_RAW ? "raw" : "hvsi"); 2484d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 2494d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt /* Is it our boot one ? */ 2504d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (hvterm_privs[0] == &hvterm_priv0 && 2514d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt vdev->unit_address == hvterm_priv0.termno) { 2524d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pv = hvterm_privs[0]; 2534d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt termno = 0; 2544d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pr_devel("->boot console, using termno 0\n"); 2554d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } 2564d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt /* nope, allocate a new one */ 2574d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt else { 2584d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt for (i = 0; i < MAX_NR_HVC_CONSOLES && termno < 0; i++) 2594d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (!hvterm_privs[i]) 2604d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt termno = i; 2614d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pr_devel("->non-boot console, using termno %d\n", termno); 2624d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (termno < 0) 2634d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return -ENODEV; 2644d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pv = kzalloc(sizeof(struct hvterm_priv), GFP_KERNEL); 2654d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (!pv) 2664d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return -ENOMEM; 2674d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pv->termno = vdev->unit_address; 2684d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pv->proto = proto; 2694d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_privs[termno] = pv; 27017bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt hvsi_init(&pv->hvsi, hvc_get_chars, hvc_put_chars, 27117bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt pv->termno, 0); 2724d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } 2734d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 2744d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hp = hvc_alloc(termno, vdev->irq, ops, MAX_VIO_PUT_CHARS); 275acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller if (IS_ERR(hp)) 276acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller return PTR_ERR(hp); 277acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller dev_set_drvdata(&vdev->dev, hp); 278acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 279acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller return 0; 280acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller} 281acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 282acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Millerstatic int __devexit hvc_vio_remove(struct vio_dev *vdev) 283acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller{ 284acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller struct hvc_struct *hp = dev_get_drvdata(&vdev->dev); 2854d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt int rc, termno; 286acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 2874d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt termno = hp->vtermno; 2884d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt rc = hvc_remove(hp); 2894d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (rc == 0) { 2904d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (hvterm_privs[termno] != &hvterm_priv0) 2914d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt kfree(hvterm_privs[termno]); 2924d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_privs[termno] = NULL; 2934d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } 2944d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return rc; 295acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller} 296acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 297acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Millerstatic struct vio_driver hvc_vio_driver = { 298acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller .id_table = hvc_driver_table, 299acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller .probe = hvc_vio_probe, 300e364ca92770a84ab3a917359ba7fed69479a16e3Mike Frysinger .remove = __devexit_p(hvc_vio_remove), 301acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller .driver = { 3026fdf5392caa4c3cba65add0a4beec9f5eb96b723Stephen Rothwell .name = hvc_driver_name, 303acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller .owner = THIS_MODULE, 304acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller } 305acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller}; 306acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 307948c28fe3001f2c9d852dff2a0b2c69fe7cec91bPeter Huewestatic int __init hvc_vio_init(void) 308acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller{ 309acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller int rc; 310acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 311de0138da0f8cf406c096daec7494a5cbebce2e5cStephen Rothwell if (firmware_has_feature(FW_FEATURE_ISERIES)) 312de0138da0f8cf406c096daec7494a5cbebce2e5cStephen Rothwell return -EIO; 313de0138da0f8cf406c096daec7494a5cbebce2e5cStephen Rothwell 314acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller /* Register as a vio device to receive callbacks */ 315acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller rc = vio_register_driver(&hvc_vio_driver); 316acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 317acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller return rc; 318acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller} 319acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Millermodule_init(hvc_vio_init); /* after drivers/char/hvc_console.c */ 320acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 321948c28fe3001f2c9d852dff2a0b2c69fe7cec91bPeter Huewestatic void __exit hvc_vio_exit(void) 322acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller{ 323acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller vio_unregister_driver(&hvc_vio_driver); 324acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller} 325acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Millermodule_exit(hvc_vio_exit); 326acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 3274d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic void udbg_hvc_putc(char c) 328acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller{ 3294d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt int count = -1; 330acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 3314d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (c == '\n') 3324d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_hvc_putc('\r'); 333acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 3344d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt do { 3354d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt switch(hvterm_priv0.proto) { 3364d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt case HV_PROTOCOL_RAW: 3374d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt count = hvterm_raw_put_chars(0, &c, 1); 3384d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt break; 3394d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt case HV_PROTOCOL_HVSI: 3404d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt count = hvterm_hvsi_put_chars(0, &c, 1); 341acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller break; 342dc42149fccda63a5d2fa4457808c3489a5111c5eNicolas Palix } 3434d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } while(count == 0); 3444d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 3454d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 3464d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic int udbg_hvc_getc_poll(void) 3474d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 3484d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt int rc = 0; 3494d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt char c; 350acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 3514d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt switch(hvterm_priv0.proto) { 3524d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt case HV_PROTOCOL_RAW: 3534d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt rc = hvterm_raw_get_chars(0, &c, 1); 3544d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt break; 3554d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt case HV_PROTOCOL_HVSI: 3564d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt rc = hvterm_hvsi_get_chars(0, &c, 1); 3574d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt break; 3584d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } 3594d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (!rc) 3604d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return -1; 3614d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return c; 3624d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 363acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 3644d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic int udbg_hvc_getc(void) 3654d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 3664d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt int ch; 3674d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt for (;;) { 3684d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt ch = udbg_hvc_getc_poll(); 3694d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (ch == -1) { 3704d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt /* This shouldn't be needed...but... */ 3714d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt volatile unsigned long delay; 3724d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt for (delay=0; delay < 2000000; delay++) 3734d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt ; 3744d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } else { 3754d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return ch; 376acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller } 377acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller } 3784d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 3794d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 3804d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtvoid __init hvc_vio_init_early(void) 3814d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 3824d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct device_node *stdout_node; 3834d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt const u32 *termno; 3844d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt const char *name; 3854d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt const struct hv_ops *ops; 3864d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 3874d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt /* find the boot console from /chosen/stdout */ 3884d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (!of_chosen) 3894d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return; 3904d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt name = of_get_property(of_chosen, "linux,stdout-path", NULL); 3914d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (name == NULL) 3924d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return; 3934d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt stdout_node = of_find_node_by_path(name); 3944d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (!stdout_node) 3954d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return; 3964d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt name = of_get_property(stdout_node, "name", NULL); 3974d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (!name) { 3984d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt printk(KERN_WARNING "stdout node missing 'name' property!\n"); 3994d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt goto out; 4004d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } 4014d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 4024d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt /* Check if it's a virtual terminal */ 4034d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (strncmp(name, "vty", 3) != 0) 4044d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt goto out; 4054d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt termno = of_get_property(stdout_node, "reg", NULL); 4064d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (termno == NULL) 4074d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt goto out; 4084d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_priv0.termno = *termno; 4094d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_privs[0] = &hvterm_priv0; 4104d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 4114d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt /* Check the protocol */ 4124d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (of_device_is_compatible(stdout_node, "hvterm1")) { 4134d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_priv0.proto = HV_PROTOCOL_RAW; 4144d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt ops = &hvterm_raw_ops; 4154d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } 4164d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt else if (of_device_is_compatible(stdout_node, "hvterm-protocol")) { 4174d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_priv0.proto = HV_PROTOCOL_HVSI; 4184d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt ops = &hvterm_hvsi_ops; 41917bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt hvsi_init(&hvterm_priv0.hvsi, hvc_get_chars, hvc_put_chars, 42017bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt hvterm_priv0.termno, 1); 4214d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt /* HVSI, perform the handshake now */ 42217bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt hvsi_establish(&hvterm_priv0.hvsi); 4234d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } else 4244d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt goto out; 4254d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_putc = udbg_hvc_putc; 4264d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_getc = udbg_hvc_getc; 4274d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_getc_poll = udbg_hvc_getc_poll; 4284d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#ifdef HVC_OLD_HVSI 4294d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt /* When using the old HVSI driver don't register the HVC 4304d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt * backend for HVSI, only do udbg 4314d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt */ 4324d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (hvterm_priv0.proto == HV_PROTOCOL_HVSI) 4334d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt goto out; 4344d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#endif 4354d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt add_preferred_console("hvc", 0, NULL); 4364d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvc_instantiate(0, 0, ops); 4374d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtout: 4384d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt of_node_put(stdout_node); 4394d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 4404d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 4414d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt/* call this from early_init() for a working debug console on 4424d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt * vterm capable LPAR machines 4434d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt */ 4444d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#ifdef CONFIG_PPC_EARLY_DEBUG_LPAR 4454d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtvoid __init udbg_init_debug_lpar(void) 4464d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 4474d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_privs[0] = &hvterm_priv0; 4484d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_priv0.termno = 0; 4494d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_priv0.proto = HV_PROTOCOL_RAW; 4504d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_putc = udbg_hvc_putc; 4514d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_getc = udbg_hvc_getc; 4524d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_getc_poll = udbg_hvc_getc_poll; 4534d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 4544d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#endif /* CONFIG_PPC_EARLY_DEBUG_LPAR */ 455acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 4564d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#ifdef CONFIG_PPC_EARLY_DEBUG_LPAR_HVSI 4574d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtvoid __init udbg_init_debug_lpar_hvsi(void) 4584d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 4594d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_privs[0] = &hvterm_priv0; 4604d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_priv0.termno = CONFIG_PPC_EARLY_DEBUG_HVSI_VTERMNO; 4614d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_priv0.proto = HV_PROTOCOL_HVSI; 4624d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_putc = udbg_hvc_putc; 4634d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_getc = udbg_hvc_getc; 4644d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_getc_poll = udbg_hvc_getc_poll; 46517bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt hvsi_init(&hvterm_priv0.hvsi, hvc_get_chars, hvc_put_chars, 46617bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt hvterm_priv0.termno, 1); 46717bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt hvsi_establish(&hvterm_priv0.hvsi); 468acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller} 4694d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#endif /* CONFIG_PPC_EARLY_DEBUG_LPAR_HVSI */ 470