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> 44578b9ce0095ff3dd2c3b94508407c3be8fcce68dPaul Gortmaker#include <linux/module.h> 4545d607ed92695d7543f5e1fc5b133cd69834e3e4Ryan S. Arnold 46acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller#include <asm/hvconsole.h> 47acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller#include <asm/vio.h> 48acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller#include <asm/prom.h> 494d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#include <asm/hvsi.h> 504d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#include <asm/udbg.h> 511926d0aeecf0280c67bf7464b2d68fe4e92c566bBen Hutchings#include <asm/machdep.h> 52acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 5345d607ed92695d7543f5e1fc5b133cd69834e3e4Ryan S. Arnold#include "hvc_console.h" 5445d607ed92695d7543f5e1fc5b133cd69834e3e4Ryan S. Arnold 555a71c61b7724ad0acedff254e07dc1a7dd05ee76Joe Perchesstatic const char hvc_driver_name[] = "hvc_console"; 56acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 57de88b34042752c03771b779d1d985060909ab44aBill Pembertonstatic struct vio_device_id hvc_driver_table[] = { 58acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller {"serial", "hvterm1"}, 594d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#ifndef HVC_OLD_HVSI 604d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt {"serial", "hvterm-protocol"}, 614d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#endif 62fb120da678c517f72d4b39932062c2191827b331Stephen Rothwell { "", "" } 63acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller}; 64acad9559f1054487292eb10d7bb81f256e9d8f2dMilton MillerMODULE_DEVICE_TABLE(vio, hvc_driver_table); 65acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 664d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidttypedef enum hv_protocol { 674d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt HV_PROTOCOL_RAW, 684d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt HV_PROTOCOL_HVSI 694d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} hv_protocol_t; 704d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 714d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstruct hvterm_priv { 7217bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt u32 termno; /* HV term number */ 7317bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt hv_protocol_t proto; /* Raw data or HVSI packets */ 7417bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt struct hvsi_priv hvsi; /* HVSI specific data */ 7519df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard spinlock_t buf_lock; 7619df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard char buf[SIZE_VIO_GET_CHARS]; 7719df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard int left; 7819df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard int offset; 794d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt}; 804d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic struct hvterm_priv *hvterm_privs[MAX_NR_HVC_CONSOLES]; 814d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt/* For early boot console */ 824d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic struct hvterm_priv hvterm_priv0; 834d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 844d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic int hvterm_raw_get_chars(uint32_t vtermno, char *buf, int count) 8570b234a40107596a713e9981c643f2717e31463fMilton Miller{ 864d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[vtermno]; 8719df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard unsigned long i; 8819df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard unsigned long flags; 8919df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard int got; 904d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 914d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (WARN_ON(!pv)) 924d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return 0; 9370b234a40107596a713e9981c643f2717e31463fMilton Miller 9419df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard spin_lock_irqsave(&pv->buf_lock, flags); 9519df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard 9619df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard if (pv->left == 0) { 9719df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard pv->offset = 0; 9819df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard pv->left = hvc_get_chars(pv->termno, pv->buf, count); 9919df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard 10019df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard /* 10119df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard * Work around a HV bug where it gives us a null 10219df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard * after every \r. -- paulus 10319df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard */ 10419df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard for (i = 1; i < pv->left; ++i) { 10519df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard if (pv->buf[i] == 0 && pv->buf[i-1] == '\r') { 10619df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard --pv->left; 10719df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard if (i < pv->left) { 10819df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard memmove(&pv->buf[i], &pv->buf[i+1], 10919df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard pv->left - i); 11019df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard } 11119df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard } 11270b234a40107596a713e9981c643f2717e31463fMilton Miller } 11370b234a40107596a713e9981c643f2717e31463fMilton Miller } 11419df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard 11519df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard got = min(count, pv->left); 11619df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard memcpy(buf, &pv->buf[pv->offset], got); 11719df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard pv->offset += got; 11819df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard pv->left -= got; 11919df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard 12019df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard spin_unlock_irqrestore(&pv->buf_lock, flags); 12119df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard 12270b234a40107596a713e9981c643f2717e31463fMilton Miller return got; 12370b234a40107596a713e9981c643f2717e31463fMilton Miller} 12470b234a40107596a713e9981c643f2717e31463fMilton Miller 1254d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic int hvterm_raw_put_chars(uint32_t vtermno, const char *buf, int count) 1264d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 1274d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[vtermno]; 1284d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1294d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (WARN_ON(!pv)) 1304d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return 0; 1314d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1324d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return hvc_put_chars(pv->termno, buf, count); 1334d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 1344d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1354d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic const struct hv_ops hvterm_raw_ops = { 1364d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .get_chars = hvterm_raw_get_chars, 1374d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .put_chars = hvterm_raw_put_chars, 138611e097d7707741a336a0677d9d69bec40f29f3dChristian Borntraeger .notifier_add = notifier_add_irq, 139611e097d7707741a336a0677d9d69bec40f29f3dChristian Borntraeger .notifier_del = notifier_del_irq, 140fc362e2e0efd8b652ebfb409a4e43e6189c04f6fHendrik Brueckner .notifier_hangup = notifier_hangup_irq, 141030ffad23fb28fc29608a3bc21f0c3b88bf28592Milton Miller}; 142030ffad23fb28fc29608a3bc21f0c3b88bf28592Milton Miller 1434d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic int hvterm_hvsi_get_chars(uint32_t vtermno, char *buf, int count) 1444d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 1454d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[vtermno]; 1464d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1474d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (WARN_ON(!pv)) 1484d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return 0; 1494d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 15087fa35dd881fd61a2a8166892366f2c22c34a1faBenjamin Herrenschmidt return hvsilib_get_chars(&pv->hvsi, buf, count); 1514d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 1524d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1534d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic int hvterm_hvsi_put_chars(uint32_t vtermno, const char *buf, int count) 1544d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 1554d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[vtermno]; 1564d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1574d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (WARN_ON(!pv)) 1584d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return 0; 1594d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 16087fa35dd881fd61a2a8166892366f2c22c34a1faBenjamin Herrenschmidt return hvsilib_put_chars(&pv->hvsi, buf, count); 1614d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 1624d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1634d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic int hvterm_hvsi_open(struct hvc_struct *hp, int data) 1644d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 1654d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[hp->vtermno]; 1664d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt int rc; 1674d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1684d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pr_devel("HVSI@%x: open !\n", pv->termno); 1694d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1704d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt rc = notifier_add_irq(hp, data); 1714d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (rc) 1724d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return rc; 1734d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 17487fa35dd881fd61a2a8166892366f2c22c34a1faBenjamin Herrenschmidt return hvsilib_open(&pv->hvsi, hp); 1754d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 1764d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1774d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic void hvterm_hvsi_close(struct hvc_struct *hp, int data) 1784d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 1794d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[hp->vtermno]; 1804d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 18117bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt pr_devel("HVSI@%x: do close !\n", pv->termno); 1824d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 18387fa35dd881fd61a2a8166892366f2c22c34a1faBenjamin Herrenschmidt hvsilib_close(&pv->hvsi, hp); 1844d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1854d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt notifier_del_irq(hp, data); 1864d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 1874d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1884d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtvoid hvterm_hvsi_hangup(struct hvc_struct *hp, int data) 1894d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 1904d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[hp->vtermno]; 1914d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 19217bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt pr_devel("HVSI@%x: do hangup !\n", pv->termno); 1934d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 19487fa35dd881fd61a2a8166892366f2c22c34a1faBenjamin Herrenschmidt hvsilib_close(&pv->hvsi, hp); 1954d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1964d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt notifier_hangup_irq(hp, data); 1974d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 1984d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 1994d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic int hvterm_hvsi_tiocmget(struct hvc_struct *hp) 2004d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 2014d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[hp->vtermno]; 2024d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 2034d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (!pv) 2044d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return -EINVAL; 20517bdc6c0e979ae61879806e4dd93ec3b169d0931Benjamin Herrenschmidt return pv->hvsi.mctrl; 2064d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 2074d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 2084d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic int hvterm_hvsi_tiocmset(struct hvc_struct *hp, unsigned int set, 2094d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt unsigned int clear) 2104d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 2114d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv = hvterm_privs[hp->vtermno]; 2124d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 2134d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pr_devel("HVSI@%x: Set modem control, set=%x,clr=%x\n", 2144d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pv->termno, set, clear); 2154d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 2164d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (set & TIOCM_DTR) 21787fa35dd881fd61a2a8166892366f2c22c34a1faBenjamin Herrenschmidt hvsilib_write_mctrl(&pv->hvsi, 1); 2184d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt else if (clear & TIOCM_DTR) 21987fa35dd881fd61a2a8166892366f2c22c34a1faBenjamin Herrenschmidt hvsilib_write_mctrl(&pv->hvsi, 0); 2204d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 2214d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return 0; 2224d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 2234d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 2244d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtstatic const struct hv_ops hvterm_hvsi_ops = { 2254d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .get_chars = hvterm_hvsi_get_chars, 2264d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .put_chars = hvterm_hvsi_put_chars, 2274d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .notifier_add = hvterm_hvsi_open, 2284d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .notifier_del = hvterm_hvsi_close, 2294d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .notifier_hangup = hvterm_hvsi_hangup, 2304d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .tiocmget = hvterm_hvsi_tiocmget, 2314d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt .tiocmset = hvterm_hvsi_tiocmset, 2324d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt}; 2334d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 234d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidtstatic void udbg_hvc_putc(char c) 235d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt{ 236d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt int count = -1; 237d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt 238d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt if (!hvterm_privs[0]) 239d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt return; 240d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt 241d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt if (c == '\n') 242d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt udbg_hvc_putc('\r'); 243d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt 244d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt do { 245d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt switch(hvterm_privs[0]->proto) { 246d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt case HV_PROTOCOL_RAW: 247d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt count = hvterm_raw_put_chars(0, &c, 1); 248d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt break; 249d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt case HV_PROTOCOL_HVSI: 250d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt count = hvterm_hvsi_put_chars(0, &c, 1); 251d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt break; 252d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt } 253d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt } while(count == 0); 254d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt} 255d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt 256d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidtstatic int udbg_hvc_getc_poll(void) 257d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt{ 258d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt int rc = 0; 259d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt char c; 260d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt 261d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt if (!hvterm_privs[0]) 262d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt return -1; 263d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt 264d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt switch(hvterm_privs[0]->proto) { 265d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt case HV_PROTOCOL_RAW: 266d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt rc = hvterm_raw_get_chars(0, &c, 1); 267d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt break; 268d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt case HV_PROTOCOL_HVSI: 269d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt rc = hvterm_hvsi_get_chars(0, &c, 1); 270d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt break; 271d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt } 272d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt if (!rc) 273d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt return -1; 274d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt return c; 275d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt} 276d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt 277d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidtstatic int udbg_hvc_getc(void) 278d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt{ 279d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt int ch; 280d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt 281d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt if (!hvterm_privs[0]) 282d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt return -1; 283d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt 284d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt for (;;) { 285d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt ch = udbg_hvc_getc_poll(); 286d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt if (ch == -1) { 287d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt /* This shouldn't be needed...but... */ 288d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt volatile unsigned long delay; 289d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt for (delay=0; delay < 2000000; delay++) 290d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt ; 291d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt } else { 292d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt return ch; 293d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt } 294d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt } 295d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt} 296d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt 2979671f09921d93e722a28ae9610d478e092ac5466Bill Pembertonstatic int hvc_vio_probe(struct vio_dev *vdev, 2984d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt const struct vio_device_id *id) 299acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller{ 3004d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt const struct hv_ops *ops; 301acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller struct hvc_struct *hp; 3024d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt struct hvterm_priv *pv; 3034d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hv_protocol_t proto; 3044d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt int i, termno = -1; 305acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 306acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller /* probed with invalid parameters. */ 307acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller if (!vdev || !id) 308acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller return -EPERM; 309acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 3104d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (of_device_is_compatible(vdev->dev.of_node, "hvterm1")) { 3114d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt proto = HV_PROTOCOL_RAW; 3124d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt ops = &hvterm_raw_ops; 3134d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } else if (of_device_is_compatible(vdev->dev.of_node, "hvterm-protocol")) { 3144d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt proto = HV_PROTOCOL_HVSI; 3154d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt ops = &hvterm_hvsi_ops; 3164d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } else { 31746e99c4a1d57dc73e518466bb3a8da9e7094415eMasanari Iida pr_err("hvc_vio: Unknown protocol for %s\n", vdev->dev.of_node->full_name); 3184d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return -ENXIO; 3194d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } 3204d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 3214d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pr_devel("hvc_vio_probe() device %s, using %s protocol\n", 3224d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt vdev->dev.of_node->full_name, 3234d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt proto == HV_PROTOCOL_RAW ? "raw" : "hvsi"); 3244d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 3254d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt /* Is it our boot one ? */ 3264d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (hvterm_privs[0] == &hvterm_priv0 && 3274d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt vdev->unit_address == hvterm_priv0.termno) { 3284d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pv = hvterm_privs[0]; 3294d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt termno = 0; 3304d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pr_devel("->boot console, using termno 0\n"); 3314d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } 3324d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt /* nope, allocate a new one */ 3334d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt else { 3344d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt for (i = 0; i < MAX_NR_HVC_CONSOLES && termno < 0; i++) 3354d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (!hvterm_privs[i]) 3364d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt termno = i; 3374d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pr_devel("->non-boot console, using termno %d\n", termno); 3384d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (termno < 0) 3394d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return -ENODEV; 3404d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pv = kzalloc(sizeof(struct hvterm_priv), GFP_KERNEL); 3414d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (!pv) 3424d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return -ENOMEM; 3434d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pv->termno = vdev->unit_address; 3444d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt pv->proto = proto; 34519df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard spin_lock_init(&pv->buf_lock); 3464d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_privs[termno] = pv; 34787fa35dd881fd61a2a8166892366f2c22c34a1faBenjamin Herrenschmidt hvsilib_init(&pv->hvsi, hvc_get_chars, hvc_put_chars, 34887fa35dd881fd61a2a8166892366f2c22c34a1faBenjamin Herrenschmidt pv->termno, 0); 3494d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } 3504d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 3514d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hp = hvc_alloc(termno, vdev->irq, ops, MAX_VIO_PUT_CHARS); 352acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller if (IS_ERR(hp)) 353acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller return PTR_ERR(hp); 354acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller dev_set_drvdata(&vdev->dev, hp); 355acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 356d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt /* register udbg if it's not there already for console 0 */ 357d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt if (hp->index == 0 && !udbg_putc) { 358d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt udbg_putc = udbg_hvc_putc; 359d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt udbg_getc = udbg_hvc_getc; 360d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt udbg_getc_poll = udbg_hvc_getc_poll; 361d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt } 362d1cfc0ce5d3196ccd88b9d868bb7cbcab61e0a31Benjamin Herrenschmidt 363acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller return 0; 364acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller} 365acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 366ae8d8a146725a966bd7c59c94f4d0016dcf7a04fBill Pembertonstatic int hvc_vio_remove(struct vio_dev *vdev) 367acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller{ 368acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller struct hvc_struct *hp = dev_get_drvdata(&vdev->dev); 3694d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt int rc, termno; 370acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 3714d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt termno = hp->vtermno; 3724d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt rc = hvc_remove(hp); 3734d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (rc == 0) { 3744d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (hvterm_privs[termno] != &hvterm_priv0) 3754d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt kfree(hvterm_privs[termno]); 3764d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_privs[termno] = NULL; 3774d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } 3784d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return rc; 379acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller} 380acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 381acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Millerstatic struct vio_driver hvc_vio_driver = { 382acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller .id_table = hvc_driver_table, 383acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller .probe = hvc_vio_probe, 384cb52d8970eee65bf2c47d9a91bd4f58b17f595f4Benjamin Herrenschmidt .remove = hvc_vio_remove, 385cb52d8970eee65bf2c47d9a91bd4f58b17f595f4Benjamin Herrenschmidt .name = hvc_driver_name, 386acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller}; 387acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 388948c28fe3001f2c9d852dff2a0b2c69fe7cec91bPeter Huewestatic int __init hvc_vio_init(void) 389acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller{ 390acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller int rc; 391acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 392acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller /* Register as a vio device to receive callbacks */ 393acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller rc = vio_register_driver(&hvc_vio_driver); 394acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 395acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller return rc; 396acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller} 397acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Millermodule_init(hvc_vio_init); /* after drivers/char/hvc_console.c */ 398acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 399948c28fe3001f2c9d852dff2a0b2c69fe7cec91bPeter Huewestatic void __exit hvc_vio_exit(void) 400acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller{ 401acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller vio_unregister_driver(&hvc_vio_driver); 402acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller} 403acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Millermodule_exit(hvc_vio_exit); 404acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 4054d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtvoid __init hvc_vio_init_early(void) 4064d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 4071502b480e2296359728e4b4e112faf5a5599ca32Anton Blanchard const __be32 *termno; 4084d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt const char *name; 4094d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt const struct hv_ops *ops; 4104d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 4114d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt /* find the boot console from /chosen/stdout */ 412a752ee56ad84bf9a35b8323af1ad22b03c1df2c4Grant Likely if (!of_stdout) 4134d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt return; 414a752ee56ad84bf9a35b8323af1ad22b03c1df2c4Grant Likely name = of_get_property(of_stdout, "name", NULL); 4154d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (!name) { 4164d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt printk(KERN_WARNING "stdout node missing 'name' property!\n"); 417a752ee56ad84bf9a35b8323af1ad22b03c1df2c4Grant Likely return; 4184d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } 4194d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 4204d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt /* Check if it's a virtual terminal */ 4214d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (strncmp(name, "vty", 3) != 0) 422a752ee56ad84bf9a35b8323af1ad22b03c1df2c4Grant Likely return; 423a752ee56ad84bf9a35b8323af1ad22b03c1df2c4Grant Likely termno = of_get_property(of_stdout, "reg", NULL); 4244d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (termno == NULL) 425a752ee56ad84bf9a35b8323af1ad22b03c1df2c4Grant Likely return; 4261502b480e2296359728e4b4e112faf5a5599ca32Anton Blanchard hvterm_priv0.termno = of_read_number(termno, 1); 42719df9abdd30a0448e5940c6aa3527096bb69aca7Anton Blanchard spin_lock_init(&hvterm_priv0.buf_lock); 4284d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_privs[0] = &hvterm_priv0; 4294d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 4304d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt /* Check the protocol */ 431a752ee56ad84bf9a35b8323af1ad22b03c1df2c4Grant Likely if (of_device_is_compatible(of_stdout, "hvterm1")) { 4324d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_priv0.proto = HV_PROTOCOL_RAW; 4334d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt ops = &hvterm_raw_ops; 4344d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } 435a752ee56ad84bf9a35b8323af1ad22b03c1df2c4Grant Likely else if (of_device_is_compatible(of_stdout, "hvterm-protocol")) { 4364d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_priv0.proto = HV_PROTOCOL_HVSI; 4374d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt ops = &hvterm_hvsi_ops; 43887fa35dd881fd61a2a8166892366f2c22c34a1faBenjamin Herrenschmidt hvsilib_init(&hvterm_priv0.hvsi, hvc_get_chars, hvc_put_chars, 43987fa35dd881fd61a2a8166892366f2c22c34a1faBenjamin Herrenschmidt hvterm_priv0.termno, 1); 4404d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt /* HVSI, perform the handshake now */ 44187fa35dd881fd61a2a8166892366f2c22c34a1faBenjamin Herrenschmidt hvsilib_establish(&hvterm_priv0.hvsi); 4424d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt } else 443a752ee56ad84bf9a35b8323af1ad22b03c1df2c4Grant Likely return; 4444d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_putc = udbg_hvc_putc; 4454d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_getc = udbg_hvc_getc; 4464d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_getc_poll = udbg_hvc_getc_poll; 4474d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#ifdef HVC_OLD_HVSI 4484d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt /* When using the old HVSI driver don't register the HVC 4494d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt * backend for HVSI, only do udbg 4504d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt */ 4514d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt if (hvterm_priv0.proto == HV_PROTOCOL_HVSI) 452a752ee56ad84bf9a35b8323af1ad22b03c1df2c4Grant Likely return; 4534d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#endif 4541926d0aeecf0280c67bf7464b2d68fe4e92c566bBen Hutchings /* Check whether the user has requested a different console. */ 4553e47d1474c2b4099f0fadd12a6553fdb2e8feaaeAnton Blanchard if (!strstr(boot_command_line, "console=")) 4561926d0aeecf0280c67bf7464b2d68fe4e92c566bBen Hutchings add_preferred_console("hvc", 0, NULL); 4574d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvc_instantiate(0, 0, ops); 4584d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 4594d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt 4604d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt/* call this from early_init() for a working debug console on 4614d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt * vterm capable LPAR machines 4624d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt */ 4634d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#ifdef CONFIG_PPC_EARLY_DEBUG_LPAR 4644d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtvoid __init udbg_init_debug_lpar(void) 4654d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 4664d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_privs[0] = &hvterm_priv0; 4674d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_priv0.termno = 0; 4684d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_priv0.proto = HV_PROTOCOL_RAW; 469f7723f0eaf53d51ee54374116b25ac33e0be8542Benjamin Herrenschmidt spin_lock_init(&hvterm_priv0.buf_lock); 4704d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_putc = udbg_hvc_putc; 4714d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_getc = udbg_hvc_getc; 4724d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_getc_poll = udbg_hvc_getc_poll; 4734d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt} 4744d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#endif /* CONFIG_PPC_EARLY_DEBUG_LPAR */ 475acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller 4764d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#ifdef CONFIG_PPC_EARLY_DEBUG_LPAR_HVSI 4774d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidtvoid __init udbg_init_debug_lpar_hvsi(void) 4784d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt{ 4794d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_privs[0] = &hvterm_priv0; 4804d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_priv0.termno = CONFIG_PPC_EARLY_DEBUG_HVSI_VTERMNO; 4814d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt hvterm_priv0.proto = HV_PROTOCOL_HVSI; 482f7723f0eaf53d51ee54374116b25ac33e0be8542Benjamin Herrenschmidt spin_lock_init(&hvterm_priv0.buf_lock); 4834d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_putc = udbg_hvc_putc; 4844d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_getc = udbg_hvc_getc; 4854d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt udbg_getc_poll = udbg_hvc_getc_poll; 48687fa35dd881fd61a2a8166892366f2c22c34a1faBenjamin Herrenschmidt hvsilib_init(&hvterm_priv0.hvsi, hvc_get_chars, hvc_put_chars, 48787fa35dd881fd61a2a8166892366f2c22c34a1faBenjamin Herrenschmidt hvterm_priv0.termno, 1); 48887fa35dd881fd61a2a8166892366f2c22c34a1faBenjamin Herrenschmidt hvsilib_establish(&hvterm_priv0.hvsi); 489acad9559f1054487292eb10d7bb81f256e9d8f2dMilton Miller} 4904d2bb3f5003617cb42b89faefd0009c505c3abd5Benjamin Herrenschmidt#endif /* CONFIG_PPC_EARLY_DEBUG_LPAR_HVSI */ 491