|
[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index] Re: [Xen-devel] [PATCH] PV framebuffer
Applied.
Thanks,
Steven.
> This is Anthony Liguori's virtual framebuffer forward ported and
> extensively hacked based on feedback from xen-devel.
>
> Its architecture is comparable to the common split device driver
> architecture: xenfb and xenkbd modules serve as frontend in domU, and
> the user space vncfb or sdlfb process serves as backend in dom0.
>
> Signed-off-by: Markus Armbruster <armbru@xxxxxxxxxx>
> Signed-off-by: Anthony Liguori <aliguori@xxxxxxxxxx>
> ---
> Summary of changes since last submission:
>
> * Update to hg tip 12621:d1b0a5adaeab
>
> * Rename/move files to better match existing code: xenfb/ and xenkbd/
> to fbfront/, xenfb.h to fbif.h, xenkbd.h to kbdif.h.
>
> * Patched tty_io.c is identical to non-xen version; remove it from the
> sparse tree instead.
>
> linux-2.6-xen-sparse/arch/i386/kernel/setup-xen.c | 5
> linux-2.6-xen-sparse/arch/ia64/kernel/setup.c | 4
> linux-2.6-xen-sparse/arch/x86_64/kernel/setup-xen.c | 7
> linux-2.6-xen-sparse/drivers/char/tty_io.c | 3264
> --------------------
> linux-2.6-xen-sparse/drivers/xen/Kconfig | 23
> linux-2.6-xen-sparse/drivers/xen/Makefile | 2
> linux-2.6-xen-sparse/drivers/xen/console/console.c | 10
> linux-2.6-xen-sparse/drivers/xen/fbfront/Makefile | 2
> linux-2.6-xen-sparse/drivers/xen/fbfront/xenfb.c | 682 ++++
> linux-2.6-xen-sparse/drivers/xen/fbfront/xenkbd.c | 300 +
> linux-2.6-xen-sparse/mm/memory.c | 1
> tools/Makefile | 1
> tools/python/xen/xend/XendDevices.py | 4
> tools/python/xen/xend/XendDomainInfo.py | 19
> tools/python/xen/xend/image.py | 74
> tools/python/xen/xend/server/vfbif.py | 29
> tools/python/xen/xm/create.py | 34
> tools/xenfb/Makefile | 35
> tools/xenfb/sdlfb.c | 334 ++
> tools/xenfb/vncfb.c | 393 ++
> tools/xenfb/xenfb.c | 691 ++++
> tools/xenfb/xenfb.h | 34
> xen/include/public/io/fbif.h | 116
> xen/include/public/io/kbdif.h | 108
> 24 files changed, 2895 insertions(+), 3277 deletions(-)
>
> diff -r 2773c39df9a6 linux-2.6-xen-sparse/arch/i386/kernel/setup-xen.c
> --- a/linux-2.6-xen-sparse/arch/i386/kernel/setup-xen.c Wed Nov 29
> 12:16:19 2006 +0000
> +++ b/linux-2.6-xen-sparse/arch/i386/kernel/setup-xen.c Thu Nov 30
> 15:13:53 2006 +0100
> @@ -1850,8 +1850,9 @@ void __init setup_arch(char **cmdline_p)
> #endif
> #endif
> } else {
> - extern int console_use_vt;
> - console_use_vt = 0;
> +#if defined(CONFIG_VT) && defined(CONFIG_DUMMY_CONSOLE)
> + conswitchp = &dummy_con;
> +#endif
> }
> }
>
> diff -r 2773c39df9a6 linux-2.6-xen-sparse/arch/ia64/kernel/setup.c
> --- a/linux-2.6-xen-sparse/arch/ia64/kernel/setup.c Wed Nov 29 12:16:19
> 2006 +0000
> +++ b/linux-2.6-xen-sparse/arch/ia64/kernel/setup.c Thu Nov 30 15:13:53
> 2006 +0100
> @@ -550,9 +550,9 @@ setup_arch (char **cmdline_p)
> xen_start_info->nr_pages, xen_start_info->flags);
>
> if (!is_initial_xendomain()) {
> - extern int console_use_vt;
> +#if !defined(CONFIG_VT) || !defined(CONFIG_DUMMY_CONSOLE)
> conswitchp = NULL;
> - console_use_vt = 0;
> +#endif
> }
> }
> #endif
> diff -r 2773c39df9a6 linux-2.6-xen-sparse/arch/x86_64/kernel/setup-xen.c
> --- a/linux-2.6-xen-sparse/arch/x86_64/kernel/setup-xen.c Wed Nov 29
> 12:16:19 2006 +0000
> +++ b/linux-2.6-xen-sparse/arch/x86_64/kernel/setup-xen.c Thu Nov 30
> 15:13:53 2006 +0100
> @@ -970,9 +970,10 @@ void __init setup_arch(char **cmdline_p)
> #endif
> #endif
> } else {
> - extern int console_use_vt;
> - console_use_vt = 0;
> - }
> +#if defined(CONFIG_VT) && defined(CONFIG_DUMMY_CONSOLE)
> + conswitchp = &dummy_con;
> +#endif
> + }
> }
> #else /* CONFIG_XEN */
>
> diff -r 2773c39df9a6 linux-2.6-xen-sparse/drivers/xen/Kconfig
> --- a/linux-2.6-xen-sparse/drivers/xen/Kconfig Wed Nov 29 12:16:19
> 2006 +0000
> +++ b/linux-2.6-xen-sparse/drivers/xen/Kconfig Thu Nov 30 15:13:53
> 2006 +0100
> @@ -172,6 +172,29 @@ config XEN_NETDEV_FRONTEND
> dedicated device-driver domain, or your master control domain
> (domain 0), then you almost certainly want to say Y here.
>
> +config XEN_FRAMEBUFFER
> + tristate "Framebuffer-device frontend driver"
> + depends on XEN && FB
> + select FB_CFB_FILLRECT
> + select FB_CFB_COPYAREA
> + select FB_CFB_IMAGEBLIT
> + default y
> + help
> + The framebuffer-device frontend drivers allows the kernel to create a
> + virtual framebuffer. This framebuffer can be viewed in another
> + domain. Unless this domain has access to a real video card, you
> + probably want to say Y here.
> +
> +config XEN_KEYBOARD
> + tristate "Keyboard-device frontend driver"
> + depends on XEN && XEN_FRAMEBUFFER && INPUT
> + default y
> + help
> + The keyboard-device frontend driver allows the kernel to create a
> + virtual keyboard. This keyboard can then be driven by another
> + domain. If you've said Y to CONFIG_XEN_FRAMEBUFFER, you probably
> + want to say Y here.
> +
> config XEN_SCRUB_PAGES
> bool "Scrub memory before freeing it to Xen"
> default y
> diff -r 2773c39df9a6 linux-2.6-xen-sparse/drivers/xen/Makefile
> --- a/linux-2.6-xen-sparse/drivers/xen/Makefile Wed Nov 29 12:16:19
> 2006 +0000
> +++ b/linux-2.6-xen-sparse/drivers/xen/Makefile Thu Nov 30 15:13:53
> 2006 +0100
> @@ -15,3 +15,5 @@ obj-$(CONFIG_XEN_NETDEV_FRONTEND) += net
> obj-$(CONFIG_XEN_NETDEV_FRONTEND) += netfront/
> obj-$(CONFIG_XEN_PCIDEV_BACKEND) += pciback/
> obj-$(CONFIG_XEN_PCIDEV_FRONTEND) += pcifront/
> +obj-$(CONFIG_XEN_FRAMEBUFFER) += fbfront/
> +obj-$(CONFIG_XEN_KEYBOARD) += fbfront/
> diff -r 2773c39df9a6 linux-2.6-xen-sparse/drivers/xen/console/console.c
> --- a/linux-2.6-xen-sparse/drivers/xen/console/console.c Wed Nov 29
> 12:16:19 2006 +0000
> +++ b/linux-2.6-xen-sparse/drivers/xen/console/console.c Thu Nov 30
> 15:13:53 2006 +0100
> @@ -57,6 +57,7 @@
> #include <xen/interface/event_channel.h>
> #include <asm/hypervisor.h>
> #include <xen/evtchn.h>
> +#include <xen/xenbus.h>
> #include <xen/xencons.h>
>
> /*
> @@ -698,6 +699,15 @@ static int __init xencons_init(void)
> printk("Xen virtual console successfully installed as %s%d\n",
> DRV(xencons_driver)->name, xc_num);
>
> + /* Check about framebuffer messing up the console */
> + if (!is_initial_xendomain() &&
> + !xenbus_exists(XBT_NIL, "device", "vfb")) {
> + /* FIXME: this is ugly */
> + unregister_console(&kcons_info);
> + kcons_info.flags |= CON_CONSDEV;
> + register_console(&kcons_info);
> + }
> +
> return 0;
> }
>
> diff -r 2773c39df9a6 linux-2.6-xen-sparse/mm/memory.c
> --- a/linux-2.6-xen-sparse/mm/memory.c Wed Nov 29 12:16:19 2006 +0000
> +++ b/linux-2.6-xen-sparse/mm/memory.c Thu Nov 30 15:13:53 2006 +0100
> @@ -882,6 +882,7 @@ unsigned long zap_page_range(struct vm_a
> tlb_finish_mmu(tlb, address, end);
> return end;
> }
> +EXPORT_SYMBOL(zap_page_range);
>
> /*
> * Do a quick page-table lookup for a single page.
> diff -r 2773c39df9a6 tools/Makefile
> --- a/tools/Makefile Wed Nov 29 12:16:19 2006 +0000
> +++ b/tools/Makefile Wed Nov 29 13:56:23 2006 +0100
> @@ -19,6 +19,7 @@ SUBDIRS-y += libaio
> SUBDIRS-y += libaio
> SUBDIRS-y += blktap
> SUBDIRS-y += libfsimage
> +SUBDIRS-y += xenfb
> SUBDIRS-$(LIBXENAPI_BINDINGS) += libxen
>
> # These don't cross-compile
> diff -r 2773c39df9a6 tools/python/xen/xend/XendDevices.py
> --- a/tools/python/xen/xend/XendDevices.py Wed Nov 29 12:16:19 2006 +0000
> +++ b/tools/python/xen/xend/XendDevices.py Thu Nov 23 18:54:35 2006 +0100
> @@ -19,7 +19,7 @@
> # A collection of DevControllers
> #
>
> -from xen.xend.server import blkif, netif, tpmif, pciif, iopif, irqif, usbif
> +from xen.xend.server import blkif, netif, tpmif, pciif, iopif, irqif, usbif,
> vfbif
> from xen.xend.server.BlktapController import BlktapController
>
> class XendDevices:
> @@ -41,6 +41,8 @@ class XendDevices:
> 'irq': irqif.IRQController,
> 'usb': usbif.UsbifController,
> 'tap': BlktapController,
> + 'vfb': vfbif.VfbifController,
> + 'vkbd': vfbif.VkbdifController,
> }
>
> #@classmethod
> diff -r 2773c39df9a6 tools/python/xen/xend/XendDomainInfo.py
> --- a/tools/python/xen/xend/XendDomainInfo.py Wed Nov 29 12:16:19 2006 +0000
> +++ b/tools/python/xen/xend/XendDomainInfo.py Wed Nov 29 13:56:25 2006 +0100
> @@ -458,7 +458,7 @@ class XendDomainInfo:
> try:
> self._constructDomain()
> self._storeVmDetails()
> - self._createDevices()
> + self._restoreDomain()
> self._createChannels()
> self._storeDomDetails()
> self._endRestore()
> @@ -1330,6 +1330,23 @@ class XendDomainInfo:
> self.image.cleanupBootloading()
> raise VmError(str(exn))
>
> +
> + def _restoreDomain(self):
> + log.debug('XendDomainInfo.restoreDomain: %s %s',
> + self.domid,
> + self.info['cpu_weight'])
> +
> + if not self.infoIsSet('image'):
> + raise VmError('Missing image in configuration')
> +
> + try:
> + self.image = image.create(self,
> + self.info['image'],
> + self.info['device'])
> +
> + self._createDevices()
> + except RuntimeError, exn:
> + raise VmError(str(exn))
>
> def cleanupDomain(self):
> """Cleanup domain resources; release devices. Idempotent. Nothrow
> diff -r 2773c39df9a6 tools/python/xen/xend/image.py
> --- a/tools/python/xen/xend/image.py Wed Nov 29 12:16:19 2006 +0000
> +++ b/tools/python/xen/xend/image.py Wed Nov 29 13:56:25 2006 +0100
> @@ -23,6 +23,7 @@ import signal
> import signal
>
> import xen.lowlevel.xc
> +import xen.util.auxbin
> from xen.xend import sxp
> from xen.xend.XendError import VmError, XendError
> from xen.xend.XendLogging import log
> @@ -209,6 +210,79 @@ class LinuxImageHandler(ImageHandler):
> cmdline = self.cmdline,
> ramdisk = self.ramdisk,
> features = self.vm.getFeatures())
> +
> + def configure(self, imageConfig, deviceConfig):
> + ImageHandler.configure(self, imageConfig, deviceConfig)
> +
> + self.pid = 0
> + log.info("configuring linux guest")
> +
> + # set up the graphics bits.
> + # FIXME: this is much like what we do for HVM, should it be
> + # for all image types now?
> + self.display = sxp.child_value(imageConfig, 'display')
> + self.xauthority = sxp.child_value(imageConfig, 'xauthority')
> + self.vncconsole = sxp.child_value(imageConfig, 'vncconsole')
> + vncpasswd = sxp.child_value(imageConfig, 'vncpasswd')
> + self.vncpasswd = vncpasswd
> +
> + self.vnc = sxp.child_value(imageConfig, 'vnc')
> + self.sdl = sxp.child_value(imageConfig, 'sdl')
> + if self.vnc:
> + self.vncdisplay = int(sxp.child_value(imageConfig, 'vncdisplay',
> + self.vm.getDomid()))
> + self.vncunused = sxp.child_value(imageConfig, 'vncunused')
> + self.vnclisten = sxp.child_value(imageConfig, 'vnclisten')
> + if not(self.vnclisten):
> + self.vnclisten =
> xen.xend.XendRoot.instance().get_vnclisten_address()
> +
> + def createDeviceModel(self):
> + if self.pid:
> + return
> + # Execute device model (for us, it's just the fb frontend)
> + if not self.vnc and not self.sdl:
> + return
> +
> + if self.vnc:
> + args = [xen.util.auxbin.pathTo("xen-vncfb")]
> + if self.vncunused:
> + args += ['--unused']
> + elif self.vncdisplay:
> + args += [ "--vncport", "%d" %(5900 + self.vncdisplay,) ]
> + if self.vnclisten:
> + args += [ "--listen", self.vnclisten ]
> +
> + # password check
> + if self.vncpasswd is None:
> + # get password from xend-config(if password omitted, None)
> + self.vncpasswd =
> xen.xend.XendRoot.instance().get_vncpasswd_default()
> +
> + if self.vncpasswd is None:
> + raise VmError('vncpasswd is not setup in the guest
> config or xend-config.')
> + if self.vncpasswd != '':
> + self.vm.storeVm("vncpasswd", self.vncpasswd)
> + log.info("vncpassword set to '%s'", self.vncpasswd)
> +
> + elif self.sdl:
> + args = [xen.util.auxbin.pathTo("xen-sdlfb")]
> + args = args + [ "--domid", "%d" % self.vm.getDomid(),
> + "--title", self.vm.info['name'] ]
> +
> + env = dict(os.environ)
> + if self.display:
> + env['DISPLAY'] = self.display
> + if self.xauthority:
> + env['XAUTHORITY'] = self.xauthority
> + log.info("spawning video: %s", args)
> + self.pid = os.spawnve(os.P_NOWAIT, args[0], args, env)
> + log.info("device model pid: %d", self.pid)
> +
> + def destroy(self):
> + if not self.pid:
> + return
> + os.kill(self.pid, signal.SIGKILL)
> + os.waitpid(self.pid, 0)
> + self.pid = 0
>
> class PPC_LinuxImageHandler(LinuxImageHandler):
>
> diff -r 2773c39df9a6 tools/python/xen/xm/create.py
> --- a/tools/python/xen/xm/create.py Wed Nov 29 12:16:19 2006 +0000
> +++ b/tools/python/xen/xm/create.py Wed Nov 29 13:57:17 2006 +0100
> @@ -284,6 +284,14 @@ gopts.var('usbport', val='PATH',
> use="""Add a physical USB port to a domain, as specified by the
> path
> to that port. This option may be repeated to add more than one
> port.""")
>
> +gopts.var('vfb', val="no|yes'",
> + fn=set_bool, default=0,
> + use="Make the domain a framebuffer backend.")
> +
> +gopts.var('vkbd', val="no|yes'",
> + fn=set_bool, default=0,
> + use="Make the domain a keyboard backend.")
> +
> gopts.var('vif',
> val="type=TYPE,mac=MAC,bridge=BRIDGE,ip=IPADDR,script=SCRIPT,backend=DOM,vifname=NAME",
> fn=append_value, default=[],
> use="""Add a network interface with the given MAC address and
> bridge.
> @@ -512,8 +520,10 @@ def configure_image(vals):
> config_image.append(['args', vals.extra])
>
> if vals.builder == 'hvm':
> - configure_hvm(config_image, vals)
> -
> + configure_hvm(config_image, vals)
> +
> + configure_graphics(config_image, vals)
> +
> return config_image
>
> def configure_disks(config_devs, vals):
> @@ -564,6 +574,13 @@ def configure_usb(config_devs, vals):
> config_usb = ['usbport', ['path', path]]
> config_devs.append(['device', config_usb])
>
> +def configure_vfbs(config_devs, vals):
> + if vals.vfb:
> + config_devs.append(['device', ['vfb', []]])
> +
> +def configure_vkbds(config_devs, vals):
> + if vals.vkbd:
> + config_devs.append(['device', ['vkbd', []]])
>
> def configure_security(config, vals):
> """Create the config for ACM security labels.
> @@ -661,13 +678,20 @@ def configure_vifs(config_devs, vals):
> config_devs.append(['device', config_vif])
>
>
> +def configure_graphics(config_image, vals):
> + """Create the config for graphic consoles.
> + """
> + args = [ 'vnc', 'vncdisplay', 'vncconsole', 'vncunused',
> + 'sdl', 'display', 'xauthority', 'vnclisten', 'vncpasswd']
> + for a in args:
> + if (vals.__dict__[a]):
> + config_image.append([a, vals.__dict__[a]])
> +
> def configure_hvm(config_image, vals):
> """Create the config for HVM devices.
> """
> args = [ 'device_model', 'pae', 'vcpus', 'boot', 'fda', 'fdb',
> 'localtime', 'serial', 'stdvga', 'isa', 'nographic', 'soundhw',
> - 'vnc', 'vncdisplay', 'vncunused', 'vncconsole', 'vnclisten',
> - 'sdl', 'display', 'xauthority',
> 'acpi', 'apic', 'usb', 'usbdevice', 'keymap' ]
> for a in args:
> if a in vals.__dict__ and vals.__dict__[a] is not None:
> @@ -742,6 +766,8 @@ def make_config(vals):
> configure_vifs(config_devs, vals)
> configure_usb(config_devs, vals)
> configure_vtpm(config_devs, vals)
> + configure_vfbs(config_devs, vals)
> + configure_vkbds(config_devs, vals)
> configure_security(config, vals)
> config += config_devs
>
> diff -r 2773c39df9a6 linux-2.6-xen-sparse/drivers/xen/fbfront/Makefile
> --- /dev/null Thu Jan 01 00:00:00 1970 +0000
> +++ b/linux-2.6-xen-sparse/drivers/xen/fbfront/Makefile Thu Nov 30
> 15:13:53 2006 +0100
> @@ -0,0 +1,2 @@
> +obj-$(CONFIG_XEN_FRAMEBUFFER) := xenfb.o
> +obj-$(CONFIG_XEN_KEYBOARD) += xenkbd.o
> diff -r 2773c39df9a6 linux-2.6-xen-sparse/drivers/xen/fbfront/xenfb.c
> --- /dev/null Thu Jan 01 00:00:00 1970 +0000
> +++ b/linux-2.6-xen-sparse/drivers/xen/fbfront/xenfb.c Thu Nov 30
> 15:13:53 2006 +0100
> @@ -0,0 +1,682 @@
> +/*
> + * linux/drivers/video/xenfb.c -- Xen para-virtual frame buffer device
> + *
> + * Copyright (C) 2005-2006 Anthony Liguori <aliguori@xxxxxxxxxx>
> + * Copyright (C) 2006 Red Hat, Inc., Markus Armbruster <armbru@xxxxxxxxxx>
> + *
> + * Based on linux/drivers/video/q40fb.c
> + *
> + * This file is subject to the terms and conditions of the GNU General
> Public
> + * License. See the file COPYING in the main directory of this archive for
> + * more details.
> + */
> +
> +/*
> + * TODO:
> + *
> + * Switch to grant tables when they become capable of dealing with the
> + * frame buffer.
> + */
> +
> +#include <linux/kernel.h>
> +#include <linux/errno.h>
> +#include <linux/fb.h>
> +#include <linux/module.h>
> +#include <linux/vmalloc.h>
> +#include <linux/mm.h>
> +#include <asm/hypervisor.h>
> +#include <xen/evtchn.h>
> +#include <xen/interface/io/fbif.h>
> +#include <xen/xenbus.h>
> +#include <linux/kthread.h>
> +
> +struct xenfb_mapping
> +{
> + struct list_head link;
> + struct vm_area_struct *vma;
> + atomic_t map_refs;
> + int faults;
> + struct xenfb_info *info;
> +};
> +
> +struct xenfb_info
> +{
> + struct task_struct *kthread;
> + wait_queue_head_t wq;
> +
> + unsigned char *fb;
> + struct fb_info *fb_info;
> + struct timer_list refresh;
> + int dirty;
> + int x1, y1, x2, y2; /* dirty rectangle,
> + protected by mm_lock */
> + spinlock_t mm_lock;
> + int nr_pages;
> + struct page **pages;
> + struct list_head mappings; /* protected by mm_lock */
> +
> + unsigned evtchn;
> + int irq;
> + struct xenfb_page *page;
> + unsigned long *mfns;
> + int update_wanted; /* XENFB_TYPE_UPDATE wanted */
> +
> + struct xenbus_device *xbdev;
> +};
> +
> +static int xenfb_fps = 20;
> +static unsigned long xenfb_mem_len = XENFB_WIDTH * XENFB_HEIGHT *
> XENFB_DEPTH / 8;
> +
> +static int xenfb_remove(struct xenbus_device *);
> +static void xenfb_init_shared_page(struct xenfb_info *);
> +static int xenfb_connect_backend(struct xenbus_device *, struct xenfb_info
> *);
> +static void xenfb_disconnect_backend(struct xenfb_info *);
> +
> +static void xenfb_do_update(struct xenfb_info *info,
> + int x, int y, int w, int h)
> +{
> + union xenfb_out_event event;
> + __u32 prod;
> +
> + event.type = XENFB_TYPE_UPDATE;
> + event.update.x = x;
> + event.update.y = y;
> + event.update.width = w;
> + event.update.height = h;
> +
> + prod = info->page->out_prod;
> + /* caller ensures !xenfb_queue_full() */
> + mb(); /* ensure ring space available */
> + XENFB_OUT_RING_REF(info->page, prod) = event;
> + wmb(); /* ensure ring contents visible */
> + info->page->out_prod = prod + 1;
> +
> + notify_remote_via_evtchn(info->evtchn);
> +}
> +
> +static int xenfb_queue_full(struct xenfb_info *info)
> +{
> + __u32 cons, prod;
> +
> + prod = info->page->out_prod;
> + cons = info->page->out_cons;
> + return prod - cons == XENFB_OUT_RING_LEN;
> +}
> +
> +static void xenfb_update_screen(struct xenfb_info *info)
> +{
> + unsigned long flags;
> + int y1, y2, x1, x2;
> + struct xenfb_mapping *map;
> +
> + if (!info->update_wanted)
> + return;
> + if (xenfb_queue_full(info))
> + return;
> +
> + spin_lock_irqsave(&info->mm_lock, flags);
> +
> + y1 = info->y1;
> + y2 = info->y2;
> + x1 = info->x1;
> + x2 = info->x2;
> + info->x1 = info->y1 = INT_MAX;
> + info->x2 = info->y2 = 0;
> +
> + list_for_each_entry(map, &info->mappings, link) {
> + if (!map->faults)
> + continue;
> + zap_page_range(map->vma, map->vma->vm_start,
> + map->vma->vm_end - map->vma->vm_start, NULL);
> + map->faults = 0;
> + }
> +
> + spin_unlock_irqrestore(&info->mm_lock, flags);
> +
> + xenfb_do_update(info, x1, y1, x2 - x1, y2 - y1);
> +}
> +
> +static int xenfb_thread(void *data)
> +{
> + struct xenfb_info *info = data;
> +
> + while (!kthread_should_stop()) {
> + if (info->dirty) {
> + info->dirty = 0;
> + xenfb_update_screen(info);
> + }
> + wait_event_interruptible(info->wq,
> + kthread_should_stop() || info->dirty);
> + try_to_freeze();
> + }
> + return 0;
> +}
> +
> +static int xenfb_setcolreg(unsigned regno, unsigned red, unsigned green,
> + unsigned blue, unsigned transp,
> + struct fb_info *info)
> +{
> + u32 v;
> +
> + if (regno > info->cmap.len)
> + return 1;
> +
> + red >>= (16 - info->var.red.length);
> + green >>= (16 - info->var.green.length);
> + blue >>= (16 - info->var.blue.length);
> +
> + v = (red << info->var.red.offset) |
> + (green << info->var.green.offset) |
> + (blue << info->var.blue.offset);
> +
> + /* FIXME is this sane? check against xxxfb_setcolreg()! */
> + switch (info->var.bits_per_pixel) {
> + case 16:
> + case 24:
> + case 32:
> + ((u32 *)info->pseudo_palette)[regno] = v;
> + break;
> + }
> +
> + return 0;
> +}
> +
> +static void xenfb_timer(unsigned long data)
> +{
> + struct xenfb_info *info = (struct xenfb_info *)data;
> + info->dirty = 1;
> + wake_up(&info->wq);
> +}
> +
> +static void __xenfb_refresh(struct xenfb_info *info,
> + int x1, int y1, int w, int h)
> +{
> + int y2, x2;
> +
> + y2 = y1 + h;
> + x2 = x1 + w;
> +
> + if (info->y1 > y1)
> + info->y1 = y1;
> + if (info->y2 < y2)
> + info->y2 = y2;
> + if (info->x1 > x1)
> + info->x1 = x1;
> + if (info->x2 < x2)
> + info->x2 = x2;
> +
> + if (timer_pending(&info->refresh))
> + return;
> +
> + mod_timer(&info->refresh, jiffies + HZ/xenfb_fps);
> +}
> +
> +static void xenfb_refresh(struct xenfb_info *info,
> + int x1, int y1, int w, int h)
> +{
> + unsigned long flags;
> +
> + spin_lock_irqsave(&info->mm_lock, flags);
> + __xenfb_refresh(info, x1, y1, w, h);
> + spin_unlock_irqrestore(&info->mm_lock, flags);
> +}
> +
> +static void xenfb_fillrect(struct fb_info *p, const struct fb_fillrect *rect)
> +{
> + struct xenfb_info *info = p->par;
> +
> + cfb_fillrect(p, rect);
> + xenfb_refresh(info, rect->dx, rect->dy, rect->width, rect->height);
> +}
> +
> +static void xenfb_imageblit(struct fb_info *p, const struct fb_image *image)
> +{
> + struct xenfb_info *info = p->par;
> +
> + cfb_imageblit(p, image);
> + xenfb_refresh(info, image->dx, image->dy, image->width, image->height);
> +}
> +
> +static void xenfb_copyarea(struct fb_info *p, const struct fb_copyarea *area)
> +{
> + struct xenfb_info *info = p->par;
> +
> + cfb_copyarea(p, area);
> + xenfb_refresh(info, area->dx, area->dy, area->width, area->height);
> +}
> +
> +static void xenfb_vm_open(struct vm_area_struct *vma)
> +{
> + struct xenfb_mapping *map = vma->vm_private_data;
> + atomic_inc(&map->map_refs);
> +}
> +
> +static void xenfb_vm_close(struct vm_area_struct *vma)
> +{
> + struct xenfb_mapping *map = vma->vm_private_data;
> + struct xenfb_info *info = map->info;
> + unsigned long flags;
> +
> + spin_lock_irqsave(&info->mm_lock, flags);
> + if (atomic_dec_and_test(&map->map_refs)) {
> + list_del(&map->link);
> + kfree(map);
> + }
> + spin_unlock_irqrestore(&info->mm_lock, flags);
> +}
> +
> +static struct page *xenfb_vm_nopage(struct vm_area_struct *vma,
> + unsigned long vaddr, int *type)
> +{
> + struct xenfb_mapping *map = vma->vm_private_data;
> + struct xenfb_info *info = map->info;
> + int pgnr = (vaddr - vma->vm_start) >> PAGE_SHIFT;
> + unsigned long flags;
> + struct page *page;
> + int y1, y2;
> +
> + if (pgnr >= info->nr_pages)
> + return NOPAGE_SIGBUS;
> +
> + spin_lock_irqsave(&info->mm_lock, flags);
> + page = info->pages[pgnr];
> + get_page(page);
> + map->faults++;
> +
> + y1 = pgnr * PAGE_SIZE / info->fb_info->fix.line_length;
> + y2 = (pgnr * PAGE_SIZE + PAGE_SIZE - 1) /
> info->fb_info->fix.line_length;
> + if (y2 > info->fb_info->var.yres)
> + y2 = info->fb_info->var.yres;
> + __xenfb_refresh(info, 0, y1, info->fb_info->var.xres, y2 - y1);
> + spin_unlock_irqrestore(&info->mm_lock, flags);
> +
> + if (type)
> + *type = VM_FAULT_MINOR;
> +
> + return page;
> +}
> +
> +static struct vm_operations_struct xenfb_vm_ops = {
> + .open = xenfb_vm_open,
> + .close = xenfb_vm_close,
> + .nopage = xenfb_vm_nopage,
> +};
> +
> +static int xenfb_mmap(struct fb_info *fb_info, struct vm_area_struct *vma)
> +{
> + struct xenfb_info *info = fb_info->par;
> + unsigned long flags;
> + struct xenfb_mapping *map;
> + int map_pages;
> +
> + if (!(vma->vm_flags & VM_WRITE))
> + return -EINVAL;
> + if (!(vma->vm_flags & VM_SHARED))
> + return -EINVAL;
> + if (vma->vm_pgoff != 0)
> + return -EINVAL;
> +
> + map_pages = (vma->vm_end - vma->vm_start + PAGE_SIZE-1) >> PAGE_SHIFT;
> + if (map_pages > info->nr_pages)
> + return -EINVAL;
> +
> + map = kzalloc(sizeof(*map), GFP_KERNEL);
> + if (map == NULL)
> + return -ENOMEM;
> +
> + map->vma = vma;
> + map->faults = 0;
> + map->info = info;
> + atomic_set(&map->map_refs, 1);
> +
> + spin_lock_irqsave(&info->mm_lock, flags);
> + list_add(&map->link, &info->mappings);
> + spin_unlock_irqrestore(&info->mm_lock, flags);
> +
> + vma->vm_ops = &xenfb_vm_ops;
> + vma->vm_flags |= (VM_DONTEXPAND | VM_RESERVED);
> + vma->vm_private_data = map;
> +
> + return 0;
> +}
> +
> +static struct fb_ops xenfb_fb_ops = {
> + .owner = THIS_MODULE,
> + .fb_setcolreg = xenfb_setcolreg,
> + .fb_fillrect = xenfb_fillrect,
> + .fb_copyarea = xenfb_copyarea,
> + .fb_imageblit = xenfb_imageblit,
> + .fb_mmap = xenfb_mmap,
> +};
> +
> +static irqreturn_t xenfb_event_handler(int rq, void *dev_id,
> + struct pt_regs *regs)
> +{
> + /*
> + * No in events recognized, simply ignore them all.
> + * If you need to recognize some, see xenbkd's input_handler()
> + * for how to do that.
> + */
> + struct xenfb_info *info = dev_id;
> + struct xenfb_page *page = info->page;
> +
> + if (page->in_cons != page->in_prod) {
> + info->page->in_cons = info->page->in_prod;
> + notify_remote_via_evtchn(info->evtchn);
> + }
> + return IRQ_HANDLED;
> +}
> +
> +static unsigned long vmalloc_to_mfn(void *address)
> +{
> + return pfn_to_mfn(vmalloc_to_pfn(address));
> +}
> +
> +static int __devinit xenfb_probe(struct xenbus_device *dev,
> + const struct xenbus_device_id *id)
> +{
> + struct xenfb_info *info;
> + struct fb_info *fb_info;
> + int ret;
> +
> + info = kzalloc(sizeof(*info), GFP_KERNEL);
> + if (info == NULL) {
> + xenbus_dev_fatal(dev, -ENOMEM, "allocating info structure");
> + return -ENOMEM;
> + }
> + dev->dev.driver_data = info;
> + info->xbdev = dev;
> + info->irq = -1;
> + info->x1 = info->y1 = INT_MAX;
> + spin_lock_init(&info->mm_lock);
> + init_waitqueue_head(&info->wq);
> + init_timer(&info->refresh);
> + info->refresh.function = xenfb_timer;
> + info->refresh.data = (unsigned long)info;
> + INIT_LIST_HEAD(&info->mappings);
> +
> + info->fb = vmalloc(xenfb_mem_len);
> + if (info->fb == NULL)
> + goto error_nomem;
> + memset(info->fb, 0, xenfb_mem_len);
> +
> + info->nr_pages = (xenfb_mem_len + PAGE_SIZE - 1) >> PAGE_SHIFT;
> +
> + info->pages = kmalloc(sizeof(struct page *) * info->nr_pages,
> + GFP_KERNEL);
> + if (info->pages == NULL)
> + goto error_nomem;
> +
> + info->mfns = vmalloc(sizeof(unsigned long) * info->nr_pages);
> + if (!info->mfns)
> + goto error_nomem;
> +
> + /* set up shared page */
> + info->page = (void *)__get_free_page(GFP_KERNEL);
> + if (!info->page)
> + goto error_nomem;
> +
> + xenfb_init_shared_page(info);
> +
> + fb_info = framebuffer_alloc(sizeof(u32) * 256, NULL);
> + /* see fishy hackery below */
> + if (fb_info == NULL)
> + goto error_nomem;
> +
> + /* FIXME fishy hackery */
> + fb_info->pseudo_palette = fb_info->par;
> + fb_info->par = info;
> + /* /FIXME */
> + fb_info->screen_base = info->fb;
> +
> + fb_info->fbops = &xenfb_fb_ops;
> + fb_info->var.xres_virtual = fb_info->var.xres = info->page->width;
> + fb_info->var.yres_virtual = fb_info->var.yres = info->page->height;
> + fb_info->var.bits_per_pixel = info->page->depth;
> +
> + fb_info->var.red = (struct fb_bitfield){16, 8, 0};
> + fb_info->var.green = (struct fb_bitfield){8, 8, 0};
> + fb_info->var.blue = (struct fb_bitfield){0, 8, 0};
> +
> + fb_info->var.activate = FB_ACTIVATE_NOW;
> + fb_info->var.height = -1;
> + fb_info->var.width = -1;
> + fb_info->var.vmode = FB_VMODE_NONINTERLACED;
> +
> + fb_info->fix.visual = FB_VISUAL_TRUECOLOR;
> + fb_info->fix.line_length = info->page->line_length;
> + fb_info->fix.smem_start = 0;
> + fb_info->fix.smem_len = xenfb_mem_len;
> + strcpy(fb_info->fix.id, "xen");
> + fb_info->fix.type = FB_TYPE_PACKED_PIXELS;
> + fb_info->fix.accel = FB_ACCEL_NONE;
> +
> + fb_info->flags = FBINFO_FLAG_DEFAULT;
> +
> + ret = fb_alloc_cmap(&fb_info->cmap, 256, 0);
> + if (ret < 0) {
> + framebuffer_release(fb_info);
> + xenbus_dev_fatal(dev, ret, "fb_alloc_cmap");
> + goto error;
> + }
> +
> + ret = register_framebuffer(fb_info);
> + if (ret) {
> + fb_dealloc_cmap(&info->fb_info->cmap);
> + framebuffer_release(fb_info);
> + xenbus_dev_fatal(dev, ret, "register_framebuffer");
> + goto error;
> + }
> + info->fb_info = fb_info;
> +
> + /* FIXME should this be delayed until backend XenbusStateConnected? */
> + info->kthread = kthread_run(xenfb_thread, info, "xenfb thread");
> + if (IS_ERR(info->kthread)) {
> + ret = PTR_ERR(info->kthread);
> + info->kthread = NULL;
> + xenbus_dev_fatal(dev, ret, "register_framebuffer");
> + goto error;
> + }
> +
> + ret = xenfb_connect_backend(dev, info);
> + if (ret < 0)
> + goto error;
> +
> + return 0;
> +
> + error_nomem:
> + ret = -ENOMEM;
> + xenbus_dev_fatal(dev, ret, "allocating device memory");
> + error:
> + xenfb_remove(dev);
> + return ret;
> +}
> +
> +static int xenfb_resume(struct xenbus_device *dev)
> +{
> + struct xenfb_info *info = dev->dev.driver_data;
> +
> + xenfb_disconnect_backend(info);
> + xenfb_init_shared_page(info);
> + return xenfb_connect_backend(dev, info);
> +}
> +
> +static int xenfb_remove(struct xenbus_device *dev)
> +{
> + struct xenfb_info *info = dev->dev.driver_data;
> +
> + del_timer(&info->refresh);
> + if (info->kthread)
> + kthread_stop(info->kthread);
> + xenfb_disconnect_backend(info);
> + if (info->fb_info) {
> + unregister_framebuffer(info->fb_info);
> + fb_dealloc_cmap(&info->fb_info->cmap);
> + framebuffer_release(info->fb_info);
> + }
> + free_page((unsigned long)info->page);
> + vfree(info->mfns);
> + kfree(info->pages);
> + vfree(info->fb);
> + kfree(info);
> +
> + return 0;
> +}
> +
> +static void xenfb_init_shared_page(struct xenfb_info *info)
> +{
> + int i;
> +
> + for (i = 0; i < info->nr_pages; i++)
> + info->pages[i] = vmalloc_to_page(info->fb + i * PAGE_SIZE);
> +
> + for (i = 0; i < info->nr_pages; i++)
> + info->mfns[i] = vmalloc_to_mfn(info->fb + i * PAGE_SIZE);
> +
> + info->page->pd[0] = vmalloc_to_mfn(info->mfns);
> + info->page->pd[1] = 0;
> + info->page->width = XENFB_WIDTH;
> + info->page->height = XENFB_HEIGHT;
> + info->page->depth = XENFB_DEPTH;
> + info->page->line_length = (info->page->depth / 8) * info->page->width;
> + info->page->mem_length = xenfb_mem_len;
> + info->page->in_cons = info->page->in_prod = 0;
> + info->page->out_cons = info->page->out_prod = 0;
> +}
> +
> +static int xenfb_connect_backend(struct xenbus_device *dev,
> + struct xenfb_info *info)
> +{
> + int ret;
> + struct xenbus_transaction xbt;
> +
> + ret = xenbus_alloc_evtchn(dev, &info->evtchn);
> + if (ret)
> + return ret;
> + ret = bind_evtchn_to_irqhandler(info->evtchn, xenfb_event_handler,
> + 0, "xenfb", info);
> + if (ret < 0) {
> + xenbus_free_evtchn(dev, info->evtchn);
> + xenbus_dev_fatal(dev, ret, "bind_evtchn_to_irqhandler");
> + return ret;
> + }
> + info->irq = ret;
> +
> + again:
> + ret = xenbus_transaction_start(&xbt);
> + if (ret) {
> + xenbus_dev_fatal(dev, ret, "starting transaction");
> + return ret;
> + }
> + ret = xenbus_printf(xbt, dev->nodename, "page-ref", "%lu",
> + virt_to_mfn(info->page));
> + if (ret)
> + goto error_xenbus;
> + ret = xenbus_printf(xbt, dev->nodename, "event-channel", "%u",
> + info->evtchn);
> + if (ret)
> + goto error_xenbus;
> + ret = xenbus_printf(xbt, dev->nodename, "feature-update", "1");
> + if (ret)
> + goto error_xenbus;
> + ret = xenbus_transaction_end(xbt, 0);
> + if (ret) {
> + if (ret == -EAGAIN)
> + goto again;
> + xenbus_dev_fatal(dev, ret, "completing transaction");
> + return ret;
> + }
> +
> + xenbus_switch_state(dev, XenbusStateInitialised);
> + return 0;
> +
> + error_xenbus:
> + xenbus_transaction_end(xbt, 1);
> + xenbus_dev_fatal(dev, ret, "writing xenstore");
> + return ret;
> +}
> +
> +static void xenfb_disconnect_backend(struct xenfb_info *info)
> +{
> + if (info->irq >= 0)
> + unbind_from_irqhandler(info->irq, info);
> + info->irq = -1;
> +}
> +
> +static void xenfb_backend_changed(struct xenbus_device *dev,
> + enum xenbus_state backend_state)
> +{
> + struct xenfb_info *info = dev->dev.driver_data;
> + int val;
> +
> + switch (backend_state) {
> + case XenbusStateInitialising:
> + case XenbusStateInitialised:
> + case XenbusStateUnknown:
> + case XenbusStateClosed:
> + break;
> +
> + case XenbusStateInitWait:
> + InitWait:
> + xenbus_switch_state(dev, XenbusStateConnected);
> + break;
> +
> + case XenbusStateConnected:
> + /*
> + * Work around xenbus race condition: If backend goes
> + * through InitWait to Connected fast enough, we can
> + * get Connected twice here.
> + */
> + if (dev->state != XenbusStateConnected)
> + goto InitWait; /* no InitWait seen yet, fudge it */
> +
> + if (xenbus_scanf(XBT_NIL, info->xbdev->otherend,
> + "request-update", "%d", &val) < 0)
> + val = 0;
> + if (val)
> + info->update_wanted = 1;
> + break;
> +
> + case XenbusStateClosing:
> + // FIXME is this safe in any dev->state?
> + xenbus_frontend_closed(dev);
> + break;
> + }
> +}
> +
> +static struct xenbus_device_id xenfb_ids[] = {
> + { "vfb" },
> + { "" }
> +};
> +
> +static struct xenbus_driver xenfb = {
> + .name = "vfb",
> + .owner = THIS_MODULE,
> + .ids = xenfb_ids,
> + .probe = xenfb_probe,
> + .remove = xenfb_remove,
> + .resume = xenfb_resume,
> + .otherend_changed = xenfb_backend_changed,
> +};
> +
> +static int __init xenfb_init(void)
> +{
> + if (!is_running_on_xen())
> + return -ENODEV;
> +
> + /* Nothing to do if running in dom0. */
> + if (is_initial_xendomain())
> + return -ENODEV;
> +
> + return xenbus_register_frontend(&xenfb);
> +}
> +
> +static void __exit xenfb_cleanup(void)
> +{
> + return xenbus_unregister_driver(&xenfb);
> +}
> +
> +module_init(xenfb_init);
> +module_exit(xenfb_cleanup);
> +
> +MODULE_LICENSE("GPL");
> diff -r 2773c39df9a6 linux-2.6-xen-sparse/drivers/xen/fbfront/xenkbd.c
> --- /dev/null Thu Jan 01 00:00:00 1970 +0000
> +++ b/linux-2.6-xen-sparse/drivers/xen/fbfront/xenkbd.c Thu Nov 30
> 15:13:53 2006 +0100
> @@ -0,0 +1,300 @@
> +/*
> + * linux/drivers/input/keyboard/xenkbd.c -- Xen para-virtual input device
> + *
> + * Copyright (C) 2005 Anthony Liguori <aliguori@xxxxxxxxxx>
> + * Copyright (C) 2006 Red Hat, Inc., Markus Armbruster <armbru@xxxxxxxxxx>
> + *
> + * Based on linux/drivers/input/mouse/sermouse.c
> + *
> + * This file is subject to the terms and conditions of the GNU General
> Public
> + * License. See the file COPYING in the main directory of this archive for
> + * more details.
> + */
> +
> +/*
> + * TODO:
> + *
> + * Switch to grant tables together with xenfb.c.
> + */
> +
> +#include <linux/kernel.h>
> +#include <linux/errno.h>
> +#include <linux/module.h>
> +#include <linux/input.h>
> +#include <asm/hypervisor.h>
> +#include <xen/evtchn.h>
> +#include <xen/interface/io/fbif.h>
> +#include <xen/interface/io/kbdif.h>
> +#include <xen/xenbus.h>
> +
> +struct xenkbd_info
> +{
> + struct input_dev *dev;
> + struct xenkbd_page *page;
> + unsigned evtchn;
> + int irq;
> + struct xenbus_device *xbdev;
> +};
> +
> +static int xenkbd_remove(struct xenbus_device *);
> +static int xenkbd_connect_backend(struct xenbus_device *, struct xenkbd_info
> *);
> +static void xenkbd_disconnect_backend(struct xenkbd_info *);
> +
> +/*
> + * Note: if you need to send out events, see xenfb_do_update() for how
> + * to do that.
> + */
> +
> +static irqreturn_t input_handler(int rq, void *dev_id, struct pt_regs *regs)
> +{
> + struct xenkbd_info *info = dev_id;
> + struct xenkbd_page *page = info->page;
> + __u32 cons, prod;
> +
> + prod = page->in_prod;
> + if (prod == page->out_cons)
> + return IRQ_HANDLED;
> + rmb(); /* ensure we see ring contents up to prod */
> + for (cons = page->in_cons; cons != prod; cons++) {
> + union xenkbd_in_event *event;
> + event = &XENKBD_IN_RING_REF(page, cons);
> +
> + switch (event->type) {
> + case XENKBD_TYPE_MOTION:
> + input_report_rel(info->dev, REL_X, event->motion.rel_x);
> + input_report_rel(info->dev, REL_Y, event->motion.rel_y);
> + break;
> + case XENKBD_TYPE_KEY:
> + input_report_key(info->dev, event->key.keycode,
> event->key.pressed);
> + break;
> + case XENKBD_TYPE_POS:
> + input_report_abs(info->dev, ABS_X, event->pos.abs_x);
> + input_report_abs(info->dev, ABS_Y, event->pos.abs_y);
> + break;
> + }
> + }
> + input_sync(info->dev);
> + mb(); /* ensure we got ring contents */
> + page->in_cons = cons;
> + notify_remote_via_evtchn(info->evtchn);
> +
> + return IRQ_HANDLED;
> +}
> +
> +int __devinit xenkbd_probe(struct xenbus_device *dev,
> + const struct xenbus_device_id *id)
> +{
> + int ret, i;
> + struct xenkbd_info *info;
> + struct input_dev *input_dev;
> +
> + info = kzalloc(sizeof(*info), GFP_KERNEL);
> + if (!info) {
> + xenbus_dev_fatal(dev, -ENOMEM, "allocating info structure");
> + return -ENOMEM;
> + }
> + dev->dev.driver_data = info;
> + info->xbdev = dev;
> +
> + info->page = (void *)__get_free_page(GFP_KERNEL);
> + if (!info->page)
> + goto error_nomem;
> + info->page->in_cons = info->page->in_prod = 0;
> + info->page->out_cons = info->page->out_prod = 0;
> +
> + input_dev = input_allocate_device();
> + if (!input_dev)
> + goto error_nomem;
> +
> + input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REL) | BIT(EV_ABS);
> + input_dev->keybit[LONG(BTN_MOUSE)]
> + = BIT(BTN_LEFT) | BIT(BTN_MIDDLE) | BIT(BTN_RIGHT);
> + /* TODO additional buttons */
> + input_dev->relbit[0] = BIT(REL_X) | BIT(REL_Y);
> +
> + /* FIXME not sure this is quite right */
> + for (i = 0; i < 256; i++)
> + set_bit(i, input_dev->keybit);
> +
> + input_dev->name = "Xen Virtual Keyboard/Mouse";
> +
> + input_set_abs_params(input_dev, ABS_X, 0, XENFB_WIDTH, 0, 0);
> + input_set_abs_params(input_dev, ABS_Y, 0, XENFB_HEIGHT, 0, 0);
> +
> + ret = input_register_device(input_dev);
> + if (ret) {
> + input_free_device(input_dev);
> + xenbus_dev_fatal(dev, ret, "input_register_device");
> + goto error;
> + }
> + info->dev = input_dev;
> +
> + ret = xenkbd_connect_backend(dev, info);
> + if (ret < 0)
> + goto error;
> +
> + return 0;
> +
> + error_nomem:
> + ret = -ENOMEM;
> + xenbus_dev_fatal(dev, ret, "allocating device memory");
> + error:
> + xenkbd_remove(dev);
> + return ret;
> +}
> +
> +static int xenkbd_resume(struct xenbus_device *dev)
> +{
> + struct xenkbd_info *info = dev->dev.driver_data;
> +
> + xenkbd_disconnect_backend(info);
> + return xenkbd_connect_backend(dev, info);
> +}
> +
> +static int xenkbd_remove(struct xenbus_device *dev)
> +{
> + struct xenkbd_info *info = dev->dev.driver_data;
> +
> + xenkbd_disconnect_backend(info);
> + input_unregister_device(info->dev);
> + free_page((unsigned long)info->page);
> + kfree(info);
> + return 0;
> +}
> +
> +static int xenkbd_connect_backend(struct xenbus_device *dev,
> + struct xenkbd_info *info)
> +{
> + int ret;
> + struct xenbus_transaction xbt;
> +
> + ret = xenbus_alloc_evtchn(dev, &info->evtchn);
> + if (ret)
> + return ret;
> + ret = bind_evtchn_to_irqhandler(info->evtchn, input_handler, 0,
> + "xenkbd", info);
> + if (ret < 0) {
> + xenbus_free_evtchn(dev, info->evtchn);
> + xenbus_dev_fatal(dev, ret, "bind_evtchn_to_irqhandler");
> + return ret;
> + }
> + info->irq = ret;
> +
> + again:
> + ret = xenbus_transaction_start(&xbt);
> + if (ret) {
> + xenbus_dev_fatal(dev, ret, "starting transaction");
> + return ret;
> + }
> + ret = xenbus_printf(xbt, dev->nodename, "page-ref", "%lu",
> + virt_to_mfn(info->page));
> + if (ret)
> + goto error_xenbus;
> + ret = xenbus_printf(xbt, dev->nodename, "event-channel", "%u",
> + info->evtchn);
> + if (ret)
> + goto error_xenbus;
> + ret = xenbus_transaction_end(xbt, 0);
> + if (ret) {
> + if (ret == -EAGAIN)
> + goto again;
> + xenbus_dev_fatal(dev, ret, "completing transaction");
> + return ret;
> + }
> +
> + xenbus_switch_state(dev, XenbusStateInitialised);
> + return 0;
> +
> + error_xenbus:
> + xenbus_transaction_end(xbt, 1);
> + xenbus_dev_fatal(dev, ret, "writing xenstore");
> + return ret;
> +}
> +
> +static void xenkbd_disconnect_backend(struct xenkbd_info *info)
> +{
> + if (info->irq >= 0)
> + unbind_from_irqhandler(info->irq, info);
> + info->irq = -1;
> +}
> +
> +static void xenkbd_backend_changed(struct xenbus_device *dev,
> + enum xenbus_state backend_state)
> +{
> + struct xenkbd_info *info = dev->dev.driver_data;
> + int ret, val;
> +
> + switch (backend_state) {
> + case XenbusStateInitialising:
> + case XenbusStateInitialised:
> + case XenbusStateUnknown:
> + case XenbusStateClosed:
> + break;
> +
> + case XenbusStateInitWait:
> + InitWait:
> + ret = xenbus_scanf(XBT_NIL, info->xbdev->otherend,
> + "feature-abs-pointer", "%d", &val);
> + if (ret < 0)
> + val = 0;
> + if (val) {
> + ret = xenbus_printf(XBT_NIL, info->xbdev->nodename,
> + "request-abs-pointer", "1");
> + if (ret)
> + ; /* FIXME */
> + }
> + xenbus_switch_state(dev, XenbusStateConnected);
> + break;
> +
> + case XenbusStateConnected:
> + /*
> + * Work around xenbus race condition: If backend goes
> + * through InitWait to Connected fast enough, we can
> + * get Connected twice here.
> + */
> + if (dev->state != XenbusStateConnected)
> + goto InitWait; /* no InitWait seen yet, fudge it */
> + break;
> +
> + case XenbusStateClosing:
> + xenbus_frontend_closed(dev);
> + break;
> + }
> +}
> +
> +static struct xenbus_device_id xenkbd_ids[] = {
> + { "vkbd" },
> + { "" }
> +};
> +
> +static struct xenbus_driver xenkbd = {
> + .name = "vkbd",
> + .owner = THIS_MODULE,
> + .ids = xenkbd_ids,
> + .probe = xenkbd_probe,
> + .remove = xenkbd_remove,
> + .resume = xenkbd_resume,
> + .otherend_changed = xenkbd_backend_changed,
> +};
> +
> +static int __init xenkbd_init(void)
> +{
> + if (!is_running_on_xen())
> + return -ENODEV;
> +
> + /* Nothing to do if running in dom0. */
> + if (is_initial_xendomain())
> + return -ENODEV;
> +
> + return xenbus_register_frontend(&xenkbd);
> +}
> +
> +static void __exit xenkbd_cleanup(void)
> +{
> + return xenbus_unregister_driver(&xenkbd);
> +}
> +
> +module_init(xenkbd_init);
> +module_exit(xenkbd_cleanup);
> +
> +MODULE_LICENSE("GPL");
> diff -r 2773c39df9a6 tools/python/xen/xend/server/vfbif.py
> --- /dev/null Thu Jan 01 00:00:00 1970 +0000
> +++ b/tools/python/xen/xend/server/vfbif.py Thu Nov 23 09:18:03 2006 +0100
> @@ -0,0 +1,29 @@
> +from xen.xend.server.DevController import DevController
> +
> +class VfbifController(DevController):
> + """Virtual frame buffer controller. Handles all vfb devices for a domain.
> + """
> +
> + def __init__(self, vm):
> + DevController.__init__(self, vm)
> +
> + def getDeviceDetails(self, config):
> + """@see DevController.getDeviceDetails"""
> + devid = 0
> + back = {}
> + front = {}
> + return (devid, back, front)
> +
> +class VkbdifController(DevController):
> + """Virtual keyboard controller. Handles all vkbd devices for a domain.
> + """
> +
> + def __init__(self, vm):
> + DevController.__init__(self, vm)
> +
> + def getDeviceDetails(self, config):
> + """@see DevController.getDeviceDetails"""
> + devid = 0
> + back = {}
> + front = {}
> + return (devid, back, front)
> diff -r 2773c39df9a6 tools/xenfb/Makefile
> --- /dev/null Thu Jan 01 00:00:00 1970 +0000
> +++ b/tools/xenfb/Makefile Thu Nov 23 11:29:49 2006 +0100
> @@ -0,0 +1,35 @@
> +XEN_ROOT=../..
> +include $(XEN_ROOT)/tools/Rules.mk
> +
> +CFLAGS += -I$(XEN_LIBXC) -I$(XEN_XENSTORE)
> -I$(XEN_ROOT)/linux-2.6-xen-sparse/include
> +LDFLAGS += -L$(XEN_LIBXC) -L$(XEN_XENSTORE)
> +
> +INSTALL = install
> +INSTALL_PROG = $(INSTALL) -m0755
> +INSTALL_DIR = $(INSTALL) -d -m0755
> +
> +.PHONY: all
> +all: build
> +
> +.PHONY: build
> +build: mk-symlinks
> + $(MAKE) vncfb sdlfb
> +
> +install: all
> + $(INSTALL_DIR) -p $(DESTDIR)/usr/$(LIBDIR)/xen/bin
> + $(INSTALL_PROG) vncfb $(DESTDIR)/usr/$(LIBDIR)/xen/bin/xen-vncfb
> + $(INSTALL_PROG) sdlfb $(DESTDIR)/usr/$(LIBDIR)/xen/bin/xen-sdlfb
> +
> +sdlfb: sdlfb.o xenfb.o
> +
> +sdlfb.o: CFLAGS += $(shell sdl-config --cflags)
> +sdlfb: LDLIBS += $(shell sdl-config --libs) -lxenctrl -lxenstore
> +
> +clean:
> + $(RM) *.o *~ vncfb sdlfb
> +
> +vncfb: vncfb.o xenfb.o
> +vncfb.o: CFLAGS += $(shell libvncserver-config --cflags)
> +vncfb: LDLIBS += $(shell libvncserver-config --libs) -lxenctrl -lxenstore
> +
> +sdlfb.o xenfb.o vncfb.o: xenfb.h
> diff -r 2773c39df9a6 tools/xenfb/sdlfb.c
> --- /dev/null Thu Jan 01 00:00:00 1970 +0000
> +++ b/tools/xenfb/sdlfb.c Thu Nov 23 11:09:50 2006 +0100
> @@ -0,0 +1,334 @@
> +#include <SDL.h>
> +#include <errno.h>
> +#include <sys/types.h>
> +#include <sys/select.h>
> +#include <stdlib.h>
> +#include <linux/input.h>
> +#include <getopt.h>
> +#include <string.h>
> +#include "xenfb.h"
> +
> +struct SDLFBData
> +{
> + SDL_Surface *dst;
> + SDL_Surface *src;
> +};
> +
> +/*
> + * Map from scancode to Linux input layer keycode. Scancodes are
> + * hardware-specific. This map assumes a standard AT or PS/2
> + * keyboard.
> + *
> + * Why use scancodes? We can't use key symbols, because they don't
> + * identify keys --- they're what keys are mapped to. The standard
> + * German keymap, for instance, maps both KEY_COMMA and KEY_102ND to
> + * SDLK_LESS.
> + */
> +static int keymap[256] = {
> + [9] = KEY_ESC,
> + [10] = KEY_1,
> + [11] = KEY_2,
> + [12] = KEY_3,
> + [13] = KEY_4,
> + [14] = KEY_5,
> + [15] = KEY_6,
> + [16] = KEY_7,
> + [17] = KEY_8,
> + [18] = KEY_9,
> + [19] = KEY_0,
> + [20] = KEY_MINUS,
> + [21] = KEY_EQUAL,
> + [22] = KEY_BACKSPACE,
> + [23] = KEY_TAB,
> + [24] = KEY_Q,
> + [25] = KEY_W,
> + [26] = KEY_E,
> + [27] = KEY_R,
> + [28] = KEY_T,
> + [29] = KEY_Y,
> + [30] = KEY_U,
> + [31] = KEY_I,
> + [32] = KEY_O,
> + [33] = KEY_P,
> + [34] = KEY_LEFTBRACE,
> + [35] = KEY_RIGHTBRACE,
> + [36] = KEY_ENTER,
> + [37] = KEY_LEFTCTRL,
> + [38] = KEY_A,
> + [39] = KEY_S,
> + [40] = KEY_D,
> + [41] = KEY_F,
> + [42] = KEY_G,
> + [43] = KEY_H,
> + [44] = KEY_J,
> + [45] = KEY_K,
> + [46] = KEY_L,
> + [47] = KEY_SEMICOLON,
> + [48] = KEY_APOSTROPHE,
> + [49] = KEY_GRAVE,
> + [50] = KEY_LEFTSHIFT,
> + [51] = KEY_BACKSLASH,
> + [52] = KEY_Z,
> + [53] = KEY_X,
> + [54] = KEY_C,
> + [55] = KEY_V,
> + [56] = KEY_B,
> + [57] = KEY_N,
> + [58] = KEY_M,
> + [59] = KEY_COMMA,
> + [60] = KEY_DOT,
> + [61] = KEY_SLASH,
> + [62] = KEY_RIGHTSHIFT,
> + [63] = KEY_KPASTERISK,
> + [64] = KEY_LEFTALT,
> + [65] = KEY_SPACE,
> + [66] = KEY_CAPSLOCK,
> + [67] = KEY_F1,
> + [68] = KEY_F2,
> + [69] = KEY_F3,
> + [70] = KEY_F4,
> + [71] = KEY_F5,
> + [72] = KEY_F6,
> + [73] = KEY_F7,
> + [74] = KEY_F8,
> + [75] = KEY_F9,
> + [76] = KEY_F10,
> + [77] = KEY_NUMLOCK,
> + [78] = KEY_SCROLLLOCK,
> + [79] = KEY_KP7,
> + [80] = KEY_KP8,
> + [81] = KEY_KP9,
> + [82] = KEY_KPMINUS,
> + [83] = KEY_KP4,
> + [84] = KEY_KP5,
> + [85] = KEY_KP6,
> + [86] = KEY_KPPLUS,
> + [87] = KEY_KP1,
> + [88] = KEY_KP2,
> + [89] = KEY_KP3,
> + [90] = KEY_KP0,
> + [91] = KEY_KPDOT,
> + [94] = KEY_102ND, /* FIXME is this correct? */
> + [95] = KEY_F11,
> + [96] = KEY_F12,
> + [108] = KEY_KPENTER,
> + [109] = KEY_RIGHTCTRL,
> + [112] = KEY_KPSLASH,
> + [111] = KEY_SYSRQ,
> + [113] = KEY_RIGHTALT,
> + [97] = KEY_HOME,
> + [98] = KEY_UP,
> + [99] = KEY_PAGEUP,
> + [100] = KEY_LEFT,
> + [102] = KEY_RIGHT,
> + [103] = KEY_END,
> + [104] = KEY_DOWN,
> + [105] = KEY_PAGEDOWN,
> + [106] = KEY_INSERT,
> + [107] = KEY_DELETE,
> + [110] = KEY_PAUSE,
> + [115] = KEY_LEFTMETA,
> + [116] = KEY_RIGHTMETA,
> + [117] = KEY_MENU,
> +};
> +
> +static int btnmap[] = {
> + [SDL_BUTTON_LEFT] = BTN_LEFT,
> + [SDL_BUTTON_MIDDLE] = BTN_MIDDLE,
> + [SDL_BUTTON_RIGHT] = BTN_RIGHT,
> + /* FIXME not 100% sure about these: */
> + [SDL_BUTTON_WHEELUP] = BTN_FORWARD,
> + [SDL_BUTTON_WHEELDOWN] BTN_BACK
> +};
> +
> +static void sdl_update(struct xenfb *xenfb, int x, int y, int width, int
> height)
> +{
> + struct SDLFBData *data = xenfb->user_data;
> + SDL_Rect r = { x, y, width, height };
> + SDL_BlitSurface(data->src, &r, data->dst, &r);
> + SDL_UpdateRect(data->dst, x, y, width, height);
> +}
> +
> +static int sdl_on_event(struct xenfb *xenfb, SDL_Event *event)
> +{
> + int x, y, ret;
> +
> + switch (event->type) {
> + case SDL_KEYDOWN:
> + case SDL_KEYUP:
> + if (keymap[event->key.keysym.scancode] == 0)
> + break;
> + ret = xenfb_send_key(xenfb,
> + event->type == SDL_KEYDOWN,
> + keymap[event->key.keysym.scancode]);
> + if (ret < 0)
> + fprintf(stderr, "Key %d %s lost (%s)\n",
> + keymap[event->key.keysym.scancode],
> + event->type == SDL_KEYDOWN ? "down" : "up",
> + strerror(errno));
> + break;
> + case SDL_MOUSEMOTION:
> + if (xenfb->abs_pointer_wanted) {
> + SDL_GetMouseState(&x, &y);
> + ret = xenfb_send_position(xenfb, x, y);
> + } else {
> + SDL_GetRelativeMouseState(&x, &y);
> + ret = xenfb_send_motion(xenfb, x, y);
> + }
> + if (ret < 0)
> + fprintf(stderr, "Pointer to %d,%d lost (%s)\n",
> + x, y, strerror(errno));
> + break;
> + case SDL_MOUSEBUTTONDOWN:
> + case SDL_MOUSEBUTTONUP:
> + if (event->button.button >= sizeof(btnmap) / sizeof(*btnmap))
> + break;
> + if (btnmap[event->button.button] == 0)
> + break;
> + ret = xenfb_send_key(xenfb,
> + event->type == SDL_MOUSEBUTTONDOWN,
> + btnmap[event->button.button]);
> + if (ret < 0)
> + fprintf(stderr, "Button %d %s lost (%s)\n",
> + btnmap[event->button.button] - BTN_MOUSE,
> + event->type == SDL_MOUSEBUTTONDOWN ? "down" :
> "up",
> + strerror(errno));
> + break;
> + case SDL_QUIT:
> + return 0;
> + }
> +
> + return 1;
> +}
> +
> +static struct option options[] = {
> + { "domid", 1, NULL, 'd' },
> + { "title", 1, NULL, 't' },
> +};
> +
> +int main(int argc, char **argv)
> +{
> + struct xenfb *xenfb;
> + int domid = -1;
> + char * title = NULL;
> + fd_set readfds;
> + int nfds;
> + struct SDLFBData data;
> + SDL_Rect r;
> + struct timeval tv;
> + SDL_Event event;
> + int do_quit = 0;
> + int opt;
> + char *endp;
> +
> + while ((opt = getopt_long(argc, argv, "d:t:", options,
> + NULL)) != -1) {
> + switch (opt) {
> + case 'd':
> + domid = strtol(optarg, &endp, 10);
> + if (endp == optarg || *endp) {
> + fprintf(stderr, "Invalid domain id
> specified\n");
> + exit(1);
> + }
> + break;
> + case 't':
> + title = strdup(optarg);
> + break;
> + }
> + }
> + if (optind != argc) {
> + fprintf(stderr, "Invalid options!\n");
> + exit(1);
> + }
> + if (domid <= 0) {
> + fprintf(stderr, "Domain ID must be specified!\n");
> + exit(1);
> + }
> +
> + xenfb = xenfb_new();
> + if (xenfb == NULL) {
> + fprintf(stderr, "Could not create framebuffer (%s)\n",
> + strerror(errno));
> + exit(1);
> + }
> +
> + if (xenfb_attach_dom(xenfb, domid) < 0) {
> + fprintf(stderr, "Could not connect to domain (%s)\n",
> + strerror(errno));
> + exit(1);
> + }
> +
> + if (SDL_Init(SDL_INIT_VIDEO) < 0) {
> + fprintf(stderr, "Could not initialize SDL\n");
> + exit(1);
> + }
> +
> + data.dst = SDL_SetVideoMode(xenfb->width, xenfb->height, xenfb->depth,
> + SDL_SWSURFACE);
> + if (!data.dst) {
> + fprintf(stderr, "SDL_SetVideoMode failed\n");
> + exit(1);
> + }
> +
> + data.src = SDL_CreateRGBSurfaceFrom(xenfb->pixels,
> + xenfb->width, xenfb->height,
> + xenfb->depth, xenfb->row_stride,
> + 0xFF0000, 0xFF00, 0xFF, 0);
> +
> + if (!data.src) {
> + fprintf(stderr, "SDL_CreateRGBSurfaceFrom failed\n");
> + exit(1);
> + }
> +
> + if (title == NULL)
> + title = strdup("xen-sdlfb");
> + SDL_WM_SetCaption(title, title);
> +
> + r.x = r.y = 0;
> + r.w = xenfb->width;
> + r.h = xenfb->height;
> + SDL_BlitSurface(data.src, &r, data.dst, &r);
> + SDL_UpdateRect(data.dst, 0, 0, xenfb->width, xenfb->height);
> +
> + xenfb->update = sdl_update;
> + xenfb->user_data = &data;
> +
> + SDL_ShowCursor(0);
> +
> + /*
> + * We need to wait for fds becoming ready or SDL events to
> + * arrive. We time out the select after 10ms to poll for SDL
> + * events. Clunky, but works. Could avoid the clunkiness
> + * with a separate thread.
> + */
> + for (;;) {
> + FD_ZERO(&readfds);
> + nfds = xenfb_select_fds(xenfb, &readfds);
> + tv = (struct timeval){0, 10000};
> +
> + if (select(nfds, &readfds, NULL, NULL, &tv) < 0) {
> + if (errno == EINTR)
> + continue;
> + fprintf(stderr,
> + "Can't select() on event channel (%s)\n",
> + strerror(errno));
> + break;
> + }
> +
> + while (SDL_PollEvent(&event)) {
> + if (!sdl_on_event(xenfb, &event))
> + do_quit = 1;
> + }
> +
> + if (do_quit)
> + break;
> +
> + xenfb_poll(xenfb, &readfds);
> + }
> +
> + xenfb_delete(xenfb);
> +
> + SDL_Quit();
> +
> + return 0;
> +}
> diff -r 2773c39df9a6 tools/xenfb/vncfb.c
> --- /dev/null Thu Jan 01 00:00:00 1970 +0000
> +++ b/tools/xenfb/vncfb.c Thu Nov 23 11:32:35 2006 +0100
> @@ -0,0 +1,393 @@
> +#define _GNU_SOURCE
> +#include <errno.h>
> +#include <getopt.h>
> +#include <stdlib.h>
> +#include <signal.h>
> +#include <unistd.h>
> +#include <malloc.h>
> +#include <rfb/rfb.h>
> +#include <rfb/keysym.h>
> +#include <linux/input.h>
> +#include <xs.h>
> +#include "xenfb.h"
> +
> +static int xk2linux[0x10000] = {
> + [XK_a] = KEY_A,
> + [XK_b] = KEY_B,
> + [XK_c] = KEY_C,
> + [XK_d] = KEY_D,
> + [XK_e] = KEY_E,
> + [XK_f] = KEY_F,
> + [XK_g] = KEY_G,
> + [XK_h] = KEY_H,
> + [XK_i] = KEY_I,
> + [XK_j] = KEY_J,
> + [XK_k] = KEY_K,
> + [XK_l] = KEY_L,
> + [XK_m] = KEY_M,
> + [XK_n] = KEY_N,
> + [XK_o] = KEY_O,
> + [XK_p] = KEY_P,
> + [XK_q] = KEY_Q,
> + [XK_r] = KEY_R,
> + [XK_s] = KEY_S,
> + [XK_t] = KEY_T,
> + [XK_u] = KEY_U,
> + [XK_v] = KEY_V,
> + [XK_w] = KEY_W,
> + [XK_x] = KEY_X,
> + [XK_y] = KEY_Y,
> + [XK_z] = KEY_Z,
> + [XK_A] = KEY_A,
> + [XK_B] = KEY_B,
> + [XK_C] = KEY_C,
> + [XK_D] = KEY_D,
> + [XK_E] = KEY_E,
> + [XK_F] = KEY_F,
> + [XK_G] = KEY_G,
> + [XK_H] = KEY_H,
> + [XK_I] = KEY_I,
> + [XK_J] = KEY_J,
> + [XK_K] = KEY_K,
> + [XK_L] = KEY_L,
> + [XK_M] = KEY_M,
> + [XK_N] = KEY_N,
> + [XK_O] = KEY_O,
> + [XK_P] = KEY_P,
> + [XK_Q] = KEY_Q,
> + [XK_R] = KEY_R,
> + [XK_S] = KEY_S,
> + [XK_T] = KEY_T,
> + [XK_U] = KEY_U,
> + [XK_V] = KEY_V,
> + [XK_W] = KEY_W,
> + [XK_X] = KEY_X,
> + [XK_Y] = KEY_Y,
> + [XK_Z] = KEY_Z,
> + [XK_0] = KEY_0,
> + [XK_1] = KEY_1,
> + [XK_2] = KEY_2,
> + [XK_3] = KEY_3,
> + [XK_4] = KEY_4,
> + [XK_5] = KEY_5,
> + [XK_6] = KEY_6,
> + [XK_7] = KEY_7,
> + [XK_8] = KEY_8,
> + [XK_9] = KEY_9,
> + [XK_Return] = KEY_ENTER,
> + [XK_BackSpace] = KEY_BACKSPACE,
> + [XK_Tab] = KEY_TAB,
> + [XK_Pause] = KEY_PAUSE,
> + [XK_Delete] = KEY_DELETE,
> + [XK_slash] = KEY_SLASH,
> + [XK_minus] = KEY_MINUS,
> + [XK_equal] = KEY_EQUAL,
> + [XK_Escape] = KEY_ESC,
> + [XK_braceleft] = KEY_LEFTBRACE,
> + [XK_braceright] = KEY_RIGHTBRACE,
> + [XK_bracketleft] = KEY_LEFTMETA,
> + [XK_bracketright] = KEY_RIGHTMETA,
> + [XK_Control_L] = KEY_LEFTCTRL,
> + [XK_Control_R] = KEY_RIGHTCTRL,
> + [XK_Shift_L] = KEY_LEFTSHIFT,
> + [XK_Shift_R] = KEY_RIGHTSHIFT,
> + [XK_Alt_L] = KEY_LEFTALT,
> + [XK_Alt_R] = KEY_RIGHTALT,
> + [XK_semicolon] = KEY_SEMICOLON,
> + [XK_apostrophe] = KEY_APOSTROPHE,
> + [XK_grave] = KEY_GRAVE,
> + [XK_backslash] = KEY_BACKSLASH,
> + [XK_comma] = KEY_COMMA,
> + [XK_period] = KEY_DOT,
> + [XK_space] = KEY_SPACE,
> + [XK_Caps_Lock] = KEY_CAPSLOCK,
> + [XK_Num_Lock] = KEY_NUMLOCK,
> + [XK_Scroll_Lock] = KEY_SCROLLLOCK,
> + [XK_Sys_Req] = KEY_SYSRQ,
> + [XK_Linefeed] = KEY_LINEFEED,
> + [XK_Home] = KEY_HOME,
> + [XK_Pause] = KEY_PAUSE,
> + [XK_F1] = KEY_F1,
> + [XK_F2] = KEY_F2,
> + [XK_F3] = KEY_F3,
> + [XK_F4] = KEY_F4,
> + [XK_F5] = KEY_F5,
> + [XK_F6] = KEY_F6,
> + [XK_F7] = KEY_F7,
> + [XK_F8] = KEY_F8,
> + [XK_F9] = KEY_F9,
> + [XK_F10] = KEY_F10,
> + [XK_F11] = KEY_F11,
> + [XK_F12] = KEY_F12,
> + [XK_Up] = KEY_UP,
> + [XK_Page_Up] = KEY_PAGEUP,
> + [XK_Left] = KEY_LEFT,
> + [XK_Right] = KEY_RIGHT,
> + [XK_End] = KEY_END,
> + [XK_Down] = KEY_DOWN,
> + [XK_Page_Down] = KEY_PAGEDOWN,
> + [XK_Insert] = KEY_INSERT,
> + [XK_colon] = KEY_SEMICOLON,
> + [XK_quotedbl] = KEY_APOSTROPHE,
> + [XK_less] = KEY_COMMA,
> + [XK_greater] = KEY_DOT,
> + [XK_question] = KEY_SLASH,
> + [XK_bar] = KEY_BACKSLASH,
> + [XK_asciitilde] = KEY_GRAVE,
> + [XK_exclam] = KEY_1,
> + [XK_at] = KEY_2,
> + [XK_numbersign] = KEY_3,
> + [XK_dollar] = KEY_4,
> + [XK_percent] = KEY_5,
> + [XK_asciicircum] = KEY_6,
> + [XK_ampersand] = KEY_7,
> + [XK_asterisk] = KEY_8,
> + [XK_parenleft] = KEY_9,
> + [XK_parenright] = KEY_0,
> + [XK_underscore] = KEY_MINUS,
> + [XK_plus] = KEY_EQUAL,
> +};
> +
> +static void on_kbd_event(rfbBool down, rfbKeySym keycode, rfbClientPtr cl)
> +{
> + /*
> + * We need to map to the key's Linux input layer keycode.
> + * Unfortunately, we don't get the key here, only the
> + * rfbKeySym, which is what the key is mapped to. Mapping
> + * back to the key is impossible in general, even when you
> + * know the keymap. For instance, the standard German keymap
> + * maps both KEY_COMMA and KEY_102ND to XK_less. We simply
> + * assume standard US layout. This sucks.
> + */
> + rfbScreenInfoPtr server = cl->screen;
> + struct xenfb *xenfb = server->screenData;
> + if (keycode >= sizeof(xk2linux) / sizeof(*xk2linux))
> + return;
> + if (xk2linux[keycode] == 0)
> + return;
> + if (xenfb_send_key(xenfb, down, xk2linux[keycode]) < 0)
> + fprintf(stderr, "Key %d %s lost (%s)\n",
> + xk2linux[keycode], down ? "down" : "up",
> + strerror(errno));
> +}
> +
> +static void on_ptr_event(int buttonMask, int x, int y, rfbClientPtr cl)
> +{
> + /* initial pointer state: at (0,0), buttons up */
> + static int last_x, last_y, last_button;
> + rfbScreenInfoPtr server = cl->screen;
> + struct xenfb *xenfb = server->screenData;
> + int i, last_down, down, ret;
> +
> + for (i = 0; i < 8; i++) {
> + last_down = last_button & (1 << i);
> + down = buttonMask & (1 << i);
> + if (down == last_down)
> + continue;
> + /* FIXME this assumes buttons are numbered the same; verify
> they are */
> + if (xenfb_send_key(xenfb, down != 0, BTN_MOUSE + i) < 0)
> + fprintf(stderr, "Button %d %s lost (%s)\n",
> + i, down ? "down" : "up", strerror(errno));
> + }
> +
> + if (x != last_x || y != last_y) {
> + if (xenfb->abs_pointer_wanted)
> + ret = xenfb_send_position(xenfb, x, y);
> + else
> + ret = xenfb_send_motion(xenfb, x - last_x, y - last_y);
> + if (ret < 0)
> + fprintf(stderr, "Pointer to %d,%d lost (%s)\n",
> + x, y, strerror(errno));
> + }
> +
> + last_button = buttonMask;
> + last_x = x;
> + last_y = y;
> +}
> +
> +static void xenstore_write_vncport(int port, int domid)
> +{
> + char *buf = NULL, *path;
> + char portstr[10];
> + struct xs_handle *xsh = NULL;
> +
> + xsh = xs_daemon_open();
> + if (xsh == NULL)
> + return;
> +
> + path = xs_get_domain_path(xsh, domid);
> + if (path == NULL) {
> + fprintf(stderr, "Can't get domain path (%s)\n",
> + strerror(errno));
> + goto out;
> + }
> +
> + if (asprintf(&buf, "%s/console/vnc-port", path) == -1) {
> + fprintf(stderr, "Can't make vncport path\n");
> + goto out;
> + }
> +
> + if (snprintf(portstr, sizeof(portstr), "%d", port) == -1) {
> + fprintf(stderr, "Can't make vncport value\n");
> + goto out;
> + }
> +
> + if (!xs_write(xsh, XBT_NULL, buf, portstr, strlen(portstr)))
> + fprintf(stderr, "Can't set vncport (%s)\n",
> + strerror(errno));
> +
> + out:
> + free(buf);
> +}
> +
> +
> +static void vnc_update(struct xenfb *xenfb, int x, int y, int w, int h)
> +{
> + rfbScreenInfoPtr server = xenfb->user_data;
> + rfbMarkRectAsModified(server, x, y, x + w, y + h);
> +}
> +
> +static struct option options[] = {
> + { "domid", 1, NULL, 'd' },
> + { "vncport", 1, NULL, 'p' },
> + { "title", 1, NULL, 't' },
> + { "unused", 0, NULL, 'u' },
> + { "listen", 1, NULL, 'l' },
> +};
> +
> +int main(int argc, char **argv)
> +{
> + rfbScreenInfoPtr server;
> + char *fake_argv[7] = { "vncfb", "-rfbport", "5901",
> + "-desktop", "xen-vncfb",
> + "-listen", "127.0.0.1" };
> + int fake_argc = sizeof(fake_argv) / sizeof(fake_argv[0]);
> + int domid = -1, port = -1;
> + char *title = NULL;
> + char *listen = NULL;
> + bool unused = false;
> + int opt;
> + struct xenfb *xenfb;
> + fd_set readfds;
> + int nfds;
> + char portstr[10];
> + char *endp;
> +
> + while ((opt = getopt_long(argc, argv, "d:p:t:u", options,
> + NULL)) != -1) {
> + switch (opt) {
> + case 'd':
> + errno = 0;
> + domid = strtol(optarg, &endp, 10);
> + if (endp == optarg || *endp || errno) {
> + fprintf(stderr, "Invalid domain id
> specified\n");
> + exit(1);
> + }
> + break;
> + case 'p':
> + errno = 0;
> + port = strtol(optarg, &endp, 10);
> + if (endp == optarg || *endp || errno) {
> + fprintf(stderr, "Invalid port specified\n");
> + exit(1);
> + }
> + break;
> + case 't':
> + title = strdup(optarg);
> + break;
> + case 'u':
> + unused = true;
> + break;
> + case 'l':
> + listen = strdup(optarg);
> + break;
> + }
> + }
> + if (optind != argc) {
> + fprintf(stderr, "Invalid options!\n");
> + exit(1);
> + }
> + if (domid <= 0) {
> + fprintf(stderr, "Domain ID must be specified!\n");
> + exit(1);
> + }
> +
> + if (port <= 0)
> + port = 5900 + domid;
> + if (snprintf(portstr, sizeof(portstr), "%d", port) == -1) {
> + fprintf(stderr, "Invalid port specified\n");
> + exit(1);
> + }
> +
> + fake_argv[2] = portstr;
> +
> + if (title != NULL)
> + fake_argv[4] = title;
> +
> + if (listen != NULL)
> + fake_argv[6] = listen;
> +
> + signal(SIGPIPE, SIG_IGN);
> +
> + xenfb = xenfb_new();
> + if (xenfb == NULL) {
> + fprintf(stderr, "Could not create framebuffer (%s)\n",
> + strerror(errno));
> + exit(1);
> + }
> +
> + if (xenfb_attach_dom(xenfb, domid) < 0) {
> + fprintf(stderr, "Could not connect to domain (%s)\n",
> + strerror(errno));
> + exit(1);
> + }
> +
> + server = rfbGetScreen(&fake_argc, fake_argv,
> + xenfb->width, xenfb->height,
> + 8, 3, xenfb->depth / 8);
> + if (server == NULL) {
> + fprintf(stderr, "Could not create VNC server\n");
> + exit(1);
> + }
> +
> + xenfb->user_data = server;
> + xenfb->update = vnc_update;
> +
> + if (unused)
> + server->autoPort = true;
> +
> + server->serverFormat.redShift = 16;
> + server->serverFormat.greenShift = 8;
> + server->serverFormat.blueShift = 0;
> + server->kbdAddEvent = on_kbd_event;
> + server->ptrAddEvent = on_ptr_event;
> + server->frameBuffer = xenfb->pixels;
> + server->screenData = xenfb;
> + server->cursor = NULL;
> + rfbInitServer(server);
> +
> + rfbRunEventLoop(server, -1, true);
> +
> + xenstore_write_vncport(server->port, domid);
> +
> + for (;;) {
> + FD_ZERO(&readfds);
> + nfds = xenfb_select_fds(xenfb, &readfds);
> +
> + if (select(nfds, &readfds, NULL, NULL, NULL) < 0) {
> + if (errno == EINTR)
> + continue;
> + fprintf(stderr,
> + "Can't select() on event channel (%s)\n",
> + strerror(errno));
> + break;
> + }
> +
> + xenfb_poll(xenfb, &readfds);
> + }
> +
> + rfbScreenCleanup(server);
> + xenfb_delete(xenfb);
> +
> + return 0;
> +}
> diff -r 2773c39df9a6 tools/xenfb/xenfb.c
> --- /dev/null Thu Jan 01 00:00:00 1970 +0000
> +++ b/tools/xenfb/xenfb.c Thu Nov 30 09:48:37 2006 +0100
> @@ -0,0 +1,691 @@
> +#include <stdarg.h>
> +#include <stdlib.h>
> +#include <sys/types.h>
> +#include <fcntl.h>
> +#include <unistd.h>
> +#include <xenctrl.h>
> +#include <xen/io/xenbus.h>
> +#include <xen/io/fbif.h>
> +#include <xen/io/kbdif.h>
> +#include <sys/select.h>
> +#include <stdbool.h>
> +#include <xen/linux/evtchn.h>
> +#include <xen/event_channel.h>
> +#include <sys/mman.h>
> +#include <errno.h>
> +#include <stdio.h>
> +#include <string.h>
> +#include <time.h>
> +#include <xs.h>
> +
> +#include "xenfb.h"
> +
> +// FIXME defend against malicious frontend?
> +
> +struct xenfb_device {
> + const char *devicetype;
> + char nodename[64]; /* backend xenstore dir */
> + char otherend[64]; /* frontend xenstore dir */
> + int otherend_id; /* frontend domid */
> + enum xenbus_state state; /* backend state */
> + void *page; /* shared page */
> + evtchn_port_t port;
> + struct xenfb_private *xenfb;
> +};
> +
> +struct xenfb_private {
> + struct xenfb pub;
> + int evt_xch; /* event channel driver handle */
> + int xc; /* hypervisor interface handle */
> + struct xs_handle *xsh; /* xs daemon handle */
> + struct xenfb_device fb, kbd;
> + size_t fb_len; /* size of framebuffer */
> +};
> +
> +static void xenfb_detach_dom(struct xenfb_private *);
> +
> +static char *xenfb_path_in_dom(struct xs_handle *xsh,
> + char *buf, size_t size,
> + unsigned domid, const char *fmt, ...)
> +{
> + va_list ap;
> + char *domp = xs_get_domain_path(xsh, domid);
> + int n;
> +
> + if (domp == NULL)
> + return NULL;
> +
> + n = snprintf(buf, size, "%s/", domp);
> + free(domp);
> + if (n >= size)
> + return NULL;
> +
> + va_start(ap, fmt);
> + n += vsnprintf(buf + n, size - n, fmt, ap);
> + va_end(ap);
> + if (n >= size)
> + return NULL;
> +
> + return buf;
> +}
> +
> +static int xenfb_xs_scanf1(struct xs_handle *xsh,
> + const char *dir, const char *node,
> + const char *fmt, void *dest)
> +{
> + char buf[1024];
> + char *p;
> + int ret;
> +
> + if (snprintf(buf, sizeof(buf), "%s/%s", dir, node) >= sizeof(buf)) {
> + errno = ENOENT;
> + return -1;
> + }
> + p = xs_read(xsh, XBT_NULL, buf, NULL);
> + if (!p) {
> + errno = ENOENT;
> + return -1;
> + }
> + ret = sscanf(p, fmt, dest);
> + free(p);
> + if (ret != 1) {
> + errno = EDOM;
> + return -1;
> + }
> + return ret;
> +}
> +
> +static int xenfb_xs_printf(struct xs_handle *xsh,
> + const char *dir, const char *node, char *fmt, ...)
> +{
> + va_list ap;
> + char key[1024];
> + char val[1024];
> + int n;
> +
> + if (snprintf(key, sizeof(key), "%s/%s", dir, node) >= sizeof(key)) {
> + errno = ENOENT;
> + return -1;
> + }
> +
> + va_start(ap, fmt);
> + n = vsnprintf(val, sizeof(val), fmt, ap);
> + va_end(ap);
> + if (n >= sizeof(val)) {
> + errno = ENOSPC; /* close enough */
> + return -1;
> + }
> +
> + if (!xs_write(xsh, XBT_NULL, key, val, n))
> + return -1;
> + return 0;
> +}
> +
> +static void xenfb_device_init(struct xenfb_device *dev,
> + const char *type,
> + struct xenfb_private *xenfb)
> +{
> + dev->devicetype = type;
> + dev->otherend_id = -1;
> + dev->port = -1;
> + dev->xenfb = xenfb;
> +}
> +
> +int xenfb_device_set_domain(struct xenfb_device *dev, int domid)
> +{
> + struct xenfb_private *xenfb = dev->xenfb;
> +
> + dev->otherend_id = domid;
> +
> + if (!xenfb_path_in_dom(xenfb->xsh,
> + dev->otherend, sizeof(dev->otherend),
> + domid, "device/%s/0", dev->devicetype)) {
> + errno = ENOENT;
> + return -1;
> + }
> + if (!xenfb_path_in_dom(xenfb->xsh,
> + dev->nodename, sizeof(dev->nodename),
> + 0, "backend/%s/%d/0", dev->devicetype, domid)) {
> + errno = ENOENT;
> + return -1;
> + }
> +
> + return 0;
> +}
> +
> +struct xenfb *xenfb_new(void)
> +{
> + struct xenfb_private *xenfb = malloc(sizeof(*xenfb));
> + int serrno;
> +
> + if (xenfb == NULL)
> + return NULL;
> +
> + memset(xenfb, 0, sizeof(*xenfb));
> + xenfb->evt_xch = xenfb->xc = -1;
> + xenfb_device_init(&xenfb->fb, "vfb", xenfb);
> + xenfb_device_init(&xenfb->kbd, "vkbd", xenfb);
> +
> + xenfb->evt_xch = xc_evtchn_open();
> + if (xenfb->evt_xch == -1)
> + goto fail;
> +
> + xenfb->xc = xc_interface_open();
> + if (xenfb->xc == -1)
> + goto fail;
> +
> + xenfb->xsh = xs_daemon_open();
> + if (!xenfb->xsh)
> + goto fail;
> +
> + return &xenfb->pub;
> +
> + fail:
> + serrno = errno;
> + xenfb_delete(&xenfb->pub);
> + errno = serrno;
> + return NULL;
> +}
> +
> +void xenfb_delete(struct xenfb *xenfb_pub)
> +{
> + struct xenfb_private *xenfb = (struct xenfb_private *)xenfb_pub;
> +
> + xenfb_detach_dom(xenfb);
> + if (xenfb->xc >= 0)
> + xc_interface_close(xenfb->xc);
> + if (xenfb->evt_xch >= 0)
> + xc_evtchn_close(xenfb->evt_xch);
> + if (xenfb->xsh)
> + xs_daemon_close(xenfb->xsh);
> + free(xenfb);
> +}
> +
> +static enum xenbus_state xenfb_read_state(struct xs_handle *xsh,
> + const char *dir)
> +{
> + int ret, state;
> +
> + ret = xenfb_xs_scanf1(xsh, dir, "state", "%d", &state);
> + if (ret < 0)
> + return XenbusStateUnknown;
> +
> + if ((unsigned)state > XenbusStateClosed)
> + state = XenbusStateUnknown;
> + return state;
> +}
> +
> +static int xenfb_switch_state(struct xenfb_device *dev,
> + enum xenbus_state state)
> +{
> + struct xs_handle *xsh = dev->xenfb->xsh;
> +
> + if (xenfb_xs_printf(xsh, dev->nodename, "state", "%d", state) < 0)
> + return -1;
> + dev->state = state;
> + return 0;
> +}
> +
> +static int xenfb_wait_for_state(struct xs_handle *xsh, const char *dir,
> + unsigned awaited)
> +{
> + unsigned state, dummy;
> + char **vec;
> +
> + for (;;) {
> + state = xenfb_read_state(xsh, dir);
> + if (state < 0)
> + return -1;
> +
> + if ((1 << state) & awaited)
> + return state;
> +
> + vec = xs_read_watch(xsh, &dummy);
> + if (!vec)
> + return -1;
> + free(vec);
> + }
> +}
> +
> +static int xenfb_wait_for_backend_creation(struct xenfb_device *dev)
> +{
> + struct xs_handle *xsh = dev->xenfb->xsh;
> + int state;
> +
> + if (!xs_watch(xsh, dev->nodename, ""))
> + return -1;
> + state = xenfb_wait_for_state(xsh, dev->nodename,
> + (1 << XenbusStateInitialising)
> + | (1 << XenbusStateClosed)
> +#if 1 /* TODO fudging state to permit restarting; to be removed */
> + | (1 << XenbusStateInitWait)
> + | (1 << XenbusStateConnected)
> + | (1 << XenbusStateClosing)
> +#endif
> + );
> + xs_unwatch(xsh, dev->nodename, "");
> +
> + switch (state) {
> +#if 1
> + case XenbusStateInitWait:
> + case XenbusStateConnected:
> + printf("Fudging state to %d\n", XenbusStateInitialising); /*
> FIXME */
> +#endif
> + case XenbusStateInitialising:
> + case XenbusStateClosing:
> + case XenbusStateClosed:
> + break;
> + default:
> + return -1;
> + }
> +
> + return 0;
> +}
> +
> +static int xenfb_hotplug(struct xenfb_device *dev)
> +{
> + if (xenfb_xs_printf(dev->xenfb->xsh, dev->nodename,
> + "hotplug-status", "connected"))
> + return -1;
> + return 0;
> +}
> +
> +static int xenfb_wait_for_frontend_initialised(struct xenfb_device *dev)
> +{
> + switch (xenfb_wait_for_state(dev->xenfb->xsh, dev->otherend,
> +#if 1 /* TODO fudging state to permit restarting; to be removed */
> + (1 << XenbusStateInitialised)
> + | (1 << XenbusStateConnected)
> +#else
> + 1 << XenbusStateInitialised,
> +#endif
> + )) {
> +#if 1
> + case XenbusStateConnected:
> + printf("Fudging state to %d\n", XenbusStateInitialised); /*
> FIXME */
> +#endif
> + case XenbusStateInitialised:
> + break;
> + default:
> + return -1;
> + }
> +
> + return 0;
> +}
> +
> +static int xenfb_map_fb(struct xenfb_private *xenfb, int domid)
> +{
> + struct xenfb_page *page = xenfb->fb.page;
> + int n_fbmfns;
> + int n_fbdirs;
> + unsigned long *fbmfns;
> +
> + n_fbmfns = (xenfb->fb_len + (XC_PAGE_SIZE - 1)) / XC_PAGE_SIZE;
> + n_fbdirs = n_fbmfns * sizeof(unsigned long);
> + n_fbdirs = (n_fbdirs + (XC_PAGE_SIZE - 1)) / XC_PAGE_SIZE;
> +
> + /*
> + * Bug alert: xc_map_foreign_batch() can fail partly and
> + * return a non-null value. This is a design flaw. When it
> + * happens, we happily continue here, and later crash on
> + * access.
> + */
> + fbmfns = xc_map_foreign_batch(xenfb->xc, domid,
> + PROT_READ, page->pd, n_fbdirs);
> + if (fbmfns == NULL)
> + return -1;
> +
> + xenfb->pub.pixels = xc_map_foreign_batch(xenfb->xc, domid,
> + PROT_READ | PROT_WRITE, fbmfns, n_fbmfns);
> + if (xenfb->pub.pixels == NULL) {
> + munmap(fbmfns, n_fbdirs * XC_PAGE_SIZE);
> + return -1;
> + }
> +
> + return munmap(fbmfns, n_fbdirs * XC_PAGE_SIZE);
> +}
> +
> +static int xenfb_bind(struct xenfb_device *dev)
> +{
> + struct xenfb_private *xenfb = dev->xenfb;
> + unsigned long mfn;
> + evtchn_port_t evtchn;
> +
> + if (xenfb_xs_scanf1(xenfb->xsh, dev->otherend, "page-ref", "%lu",
> + &mfn) < 0)
> + return -1;
> + if (xenfb_xs_scanf1(xenfb->xsh, dev->otherend, "event-channel", "%u",
> + &evtchn) < 0)
> + return -1;
> +
> + dev->port = xc_evtchn_bind_interdomain(xenfb->evt_xch,
> + dev->otherend_id, evtchn);
> + if (dev->port == -1)
> + return -1;
> +
> + dev->page = xc_map_foreign_range(xenfb->xc, dev->otherend_id,
> + XC_PAGE_SIZE, PROT_READ | PROT_WRITE, mfn);
> + if (dev->page == NULL)
> + return -1;
> +
> + return 0;
> +}
> +
> +static void xenfb_unbind(struct xenfb_device *dev)
> +{
> + if (dev->page) {
> + munmap(dev->page, XC_PAGE_SIZE);
> + dev->page = NULL;
> + }
> + if (dev->port >= 0) {
> + xc_evtchn_unbind(dev->xenfb->evt_xch, dev->port);
> + dev->port = -1;
> + }
> +}
> +
> +static int xenfb_wait_for_frontend_connected(struct xenfb_device *dev)
> +{
> + switch (xenfb_wait_for_state(dev->xenfb->xsh, dev->otherend,
> + 1 << XenbusStateConnected)) {
> + case XenbusStateConnected:
> + break;
> + default:
> + return -1;
> + }
> +
> + return 0;
> +}
> +
> +static void xenfb_dev_fatal(struct xenfb_device *dev, int err,
> + const char *fmt, ...)
> +{
> + struct xs_handle *xsh = dev->xenfb->xsh;
> + va_list ap;
> + char errdir[80];
> + char buf[1024];
> + int n;
> +
> + fprintf(stderr, "%s ", dev->nodename); /* somewhat crude */
> + va_start(ap, fmt);
> + vfprintf(stderr, fmt, ap);
> + va_end(ap);
> + if (err)
> + fprintf(stderr, " (%s)", strerror(err));
> + putc('\n', stderr);
> +
> + if (!xenfb_path_in_dom(xsh, errdir, sizeof(errdir), 0,
> + "error/%s", dev->nodename))
> + goto out; /* FIXME complain */
> +
> + va_start(ap, fmt);
> + n = snprintf(buf, sizeof(buf), "%d ", err);
> + snprintf(buf + n, sizeof(buf) - n, fmt, ap);
> + va_end(ap);
> +
> + if (xenfb_xs_printf(xsh, buf, "error", "%s", buf) < 0)
> + goto out; /* FIXME complain */
> +
> + out:
> + xenfb_switch_state(dev, XenbusStateClosing);
> +}
> +
> +int xenfb_attach_dom(struct xenfb *xenfb_pub, int domid)
> +{
> + struct xenfb_private *xenfb = (struct xenfb_private *)xenfb_pub;
> + struct xs_handle *xsh = xenfb->xsh;
> + int val, serrno;
> + struct xenfb_page *fb_page;
> +
> + xenfb_detach_dom(xenfb);
> +
> + xenfb_device_set_domain(&xenfb->fb, domid);
> + xenfb_device_set_domain(&xenfb->kbd, domid);
> +
> + if (xenfb_wait_for_backend_creation(&xenfb->fb) < 0)
> + goto error;
> + if (xenfb_wait_for_backend_creation(&xenfb->kbd) < 0)
> + goto error;
> +
> + if (xenfb_xs_printf(xsh, xenfb->kbd.nodename, "feature-abs-pointer",
> "1"))
> + goto error;
> + if (xenfb_switch_state(&xenfb->fb, XenbusStateInitWait))
> + goto error;
> + if (xenfb_switch_state(&xenfb->kbd, XenbusStateInitWait))
> + goto error;
> +
> + if (xenfb_hotplug(&xenfb->fb) < 0)
> + goto error;
> + if (xenfb_hotplug(&xenfb->kbd) < 0)
> + goto error;
> +
> + if (!xs_watch(xsh, xenfb->fb.otherend, ""))
> + goto error;
> + if (!xs_watch(xsh, xenfb->kbd.otherend, ""))
> + goto error;
> +
> + if (xenfb_wait_for_frontend_initialised(&xenfb->fb) < 0)
> + goto error;
> + if (xenfb_wait_for_frontend_initialised(&xenfb->kbd) < 0)
> + goto error;
> +
> + if (xenfb_bind(&xenfb->fb) < 0)
> + goto error;
> + if (xenfb_bind(&xenfb->kbd) < 0)
> + goto error;
> +
> + if (xenfb_xs_scanf1(xsh, xenfb->fb.otherend, "feature-update",
> + "%d", &val) < 0)
> + val = 0;
> + if (!val) {
> + errno = ENOTSUP;
> + goto error;
> + }
> + xenfb_xs_printf(xsh, xenfb->fb.nodename, "request-update", "1");
> +
> + /* TODO check for permitted ranges */
> + fb_page = xenfb->fb.page;
> + xenfb->pub.depth = fb_page->depth;
> + xenfb->pub.width = fb_page->width;
> + xenfb->pub.height = fb_page->height;
> + /* TODO check for consistency with the above */
> + xenfb->fb_len = fb_page->mem_length;
> + xenfb->pub.row_stride = fb_page->line_length;
> +
> + if (xenfb_map_fb(xenfb, domid) < 0)
> + goto error;
> +
> + if (xenfb_switch_state(&xenfb->fb, XenbusStateConnected))
> + goto error;
> + if (xenfb_switch_state(&xenfb->kbd, XenbusStateConnected))
> + goto error;
> +
> + if (xenfb_wait_for_frontend_connected(&xenfb->kbd) < 0)
> + goto error;
> + if (xenfb_xs_scanf1(xsh, xenfb->kbd.otherend, "request-abs-pointer",
> + "%d", &val) < 0)
> + val = 0;
> + xenfb->pub.abs_pointer_wanted = val;
> +
> + return 0;
> +
> + error:
> + serrno = errno;
> + xenfb_detach_dom(xenfb);
> + xenfb_dev_fatal(&xenfb->fb, serrno, "on fire");
> + xenfb_dev_fatal(&xenfb->kbd, serrno, "on fire");
> + errno = serrno;
> + return -1;
> +}
> +
> +static void xenfb_detach_dom(struct xenfb_private *xenfb)
> +{
> + xenfb_unbind(&xenfb->fb);
> + xenfb_unbind(&xenfb->kbd);
> + if (xenfb->pub.pixels) {
> + munmap(xenfb->pub.pixels, xenfb->fb_len);
> + xenfb->pub.pixels = NULL;
> + }
> +}
> +
> +static void xenfb_on_fb_event(struct xenfb_private *xenfb)
> +{
> + uint32_t prod, cons;
> + struct xenfb_page *page = xenfb->fb.page;
> +
> + prod = page->out_prod;
> + if (prod == page->out_cons)
> + return;
> + rmb(); /* ensure we see ring contents up to prod */
> + for (cons = page->out_cons; cons != prod; cons++) {
> + union xenfb_out_event *event = &XENFB_OUT_RING_REF(page, cons);
> +
> + switch (event->type) {
> + case XENFB_TYPE_UPDATE:
> + if (xenfb->pub.update)
> + xenfb->pub.update(&xenfb->pub,
> + event->update.x, event->update.y,
> + event->update.width,
> event->update.height);
> + break;
> + }
> + }
> + mb(); /* ensure we're done with ring contents */
> + page->out_cons = cons;
> + xc_evtchn_notify(xenfb->evt_xch, xenfb->fb.port);
> +}
> +
> +static void xenfb_on_kbd_event(struct xenfb_private *xenfb)
> +{
> + struct xenkbd_page *page = xenfb->kbd.page;
> +
> + /* We don't understand any keyboard events, so just ignore them. */
> + if (page->out_prod == page->out_cons)
> + return;
> + page->out_cons = page->out_prod;
> + xc_evtchn_notify(xenfb->evt_xch, xenfb->kbd.port);
> +}
> +
> +static void xenfb_on_state_change(struct xenfb_device *dev)
> +{
> + enum xenbus_state state;
> +
> + state = xenfb_read_state(dev->xenfb->xsh, dev->otherend);
> +
> + switch (state) {
> + case XenbusStateUnknown:
> + case XenbusStateInitialising:
> + case XenbusStateInitWait:
> + case XenbusStateInitialised:
> + case XenbusStateConnected:
> + break;
> + case XenbusStateClosing:
> + xenfb_unbind(dev);
> + xenfb_switch_state(dev, state);
> + break;
> + case XenbusStateClosed:
> + xs_unwatch(dev->xenfb->xsh, dev->otherend, "");
> + xenfb_switch_state(dev, state);
> + }
> +}
> +
> +int xenfb_poll(struct xenfb *xenfb_pub, fd_set *readfds)
> +{
> + struct xenfb_private *xenfb = (struct xenfb_private *)xenfb_pub;
> + evtchn_port_t port;
> + unsigned dummy;
> + char **vec;
> +
> + if (FD_ISSET(xc_evtchn_fd(xenfb->evt_xch), readfds)) {
> + port = xc_evtchn_pending(xenfb->evt_xch);
> + if (port == -1)
> + return -1;
> +
> + if (port == xenfb->fb.port)
> + xenfb_on_fb_event(xenfb);
> + else if (port == xenfb->kbd.port)
> + xenfb_on_kbd_event(xenfb);
> +
> + if (xc_evtchn_unmask(xenfb->evt_xch, port) == -1)
> + return -1;
> + }
> +
> + if (FD_ISSET(xs_fileno(xenfb->xsh), readfds)) {
> + vec = xs_read_watch(xenfb->xsh, &dummy);
> + free(vec);
> + xenfb_on_state_change(&xenfb->fb);
> + xenfb_on_state_change(&xenfb->kbd);
> + }
> +
> + return 0;
> +}
> +
> +int xenfb_select_fds(struct xenfb *xenfb_pub, fd_set *readfds)
> +{
> + struct xenfb_private *xenfb = (struct xenfb_private *)xenfb_pub;
> + int fd1 = xc_evtchn_fd(xenfb->evt_xch);
> + int fd2 = xs_fileno(xenfb->xsh);
> +
> + FD_SET(fd1, readfds);
> + FD_SET(fd2, readfds);
> + return fd1 > fd2 ? fd1 + 1 : fd2 + 1;
> +}
> +
> +static int xenfb_kbd_event(struct xenfb_private *xenfb,
> + union xenkbd_in_event *event)
> +{
> + uint32_t prod;
> + struct xenkbd_page *page = xenfb->kbd.page;
> +
> + if (xenfb->kbd.state != XenbusStateConnected)
> + return 0;
> +
> + prod = page->in_prod;
> + if (prod - page->in_cons == XENKBD_IN_RING_LEN) {
> + errno = EAGAIN;
> + return -1;
> + }
> +
> + mb(); /* ensure ring space available */
> + XENKBD_IN_RING_REF(page, prod) = *event;
> + wmb(); /* ensure ring contents visible */
> + page->in_prod = prod + 1;
> + return xc_evtchn_notify(xenfb->evt_xch, xenfb->kbd.port);
> +}
> +
> +int xenfb_send_key(struct xenfb *xenfb_pub, bool down, int keycode)
> +{
> + struct xenfb_private *xenfb = (struct xenfb_private *)xenfb_pub;
> + union xenkbd_in_event event;
> +
> + memset(&event, 0, XENKBD_IN_EVENT_SIZE);
> + event.type = XENKBD_TYPE_KEY;
> + event.key.pressed = down ? 1 : 0;
> + event.key.keycode = keycode;
> +
> + return xenfb_kbd_event(xenfb, &event);
> +}
> +
> +int xenfb_send_motion(struct xenfb *xenfb_pub, int rel_x, int rel_y)
> +{
> + struct xenfb_private *xenfb = (struct xenfb_private *)xenfb_pub;
> + union xenkbd_in_event event;
> +
> + memset(&event, 0, XENKBD_IN_EVENT_SIZE);
> + event.type = XENKBD_TYPE_MOTION;
> + event.motion.rel_x = rel_x;
> + event.motion.rel_y = rel_y;
> +
> + return xenfb_kbd_event(xenfb, &event);
> +}
> +
> +int xenfb_send_position(struct xenfb *xenfb_pub, int abs_x, int abs_y)
> +{
> + struct xenfb_private *xenfb = (struct xenfb_private *)xenfb_pub;
> + union xenkbd_in_event event;
> +
> + memset(&event, 0, XENKBD_IN_EVENT_SIZE);
> + event.type = XENKBD_TYPE_POS;
> + event.pos.abs_x = abs_x;
> + event.pos.abs_y = abs_y;
> +
> + return xenfb_kbd_event(xenfb, &event);
> +}
> diff -r 2773c39df9a6 tools/xenfb/xenfb.h
> --- /dev/null Thu Jan 01 00:00:00 1970 +0000
> +++ b/tools/xenfb/xenfb.h Thu Nov 23 11:32:28 2006 +0100
> @@ -0,0 +1,34 @@
> +#ifndef _XENFB_H_
> +#define _XENFB_H_
> +
> +#include <stdbool.h>
> +#include <sys/types.h>
> +
> +struct xenfb
> +{
> + void *pixels;
> +
> + int row_stride;
> + int depth;
> + int width;
> + int height;
> + int abs_pointer_wanted;
> +
> + void *user_data;
> +
> + void (*update)(struct xenfb *xenfb, int x, int y, int width, int
> height);
> +};
> +
> +struct xenfb *xenfb_new(void);
> +void xenfb_delete(struct xenfb *xenfb);
> +
> +int xenfb_attach_dom(struct xenfb *xenfb, int domid);
> +
> +int xenfb_select_fds(struct xenfb *xenfb, fd_set *readfds);
> +int xenfb_poll(struct xenfb *xenfb, fd_set *readfds);
> +
> +int xenfb_send_key(struct xenfb *xenfb, bool down, int keycode);
> +int xenfb_send_motion(struct xenfb *xenfb, int rel_x, int rel_y);
> +int xenfb_send_position(struct xenfb *xenfb, int abs_x, int abs_y);
> +
> +#endif
> diff -r 2773c39df9a6 xen/include/public/io/fbif.h
> --- /dev/null Thu Jan 01 00:00:00 1970 +0000
> +++ b/xen/include/public/io/fbif.h Wed Nov 29 17:34:09 2006 +0100
> @@ -0,0 +1,116 @@
> +/*
> + * fbif.h -- Xen virtual frame buffer device
> + *
> + * Copyright (C) 2005 Anthony Liguori <aliguori@xxxxxxxxxx>
> + * Copyright (C) 2006 Red Hat, Inc., Markus Armbruster <armbru@xxxxxxxxxx>
> + *
> + * This file is subject to the terms and conditions of the GNU General
> Public
> + * License. See the file COPYING in the main directory of this archive for
> + * more details.
> + */
> +
> +#ifndef __XEN_PUBLIC_IO_FBIF_H__
> +#define __XEN_PUBLIC_IO_FBIF_H__
> +
> +#include <asm/types.h>
> +
> +/* Out events (frontend -> backend) */
> +
> +/*
> + * Out events may be sent only when requested by backend, and receipt
> + * of an unknown out event is an error.
> + */
> +
> +/* Event type 1 currently not used */
> +/*
> + * Framebuffer update notification event
> + * Capable frontend sets feature-update in xenstore.
> + * Backend requests it by setting request-update in xenstore.
> + */
> +#define XENFB_TYPE_UPDATE 2
> +
> +struct xenfb_update
> +{
> + __u8 type; /* XENFB_TYPE_UPDATE */
> + __s32 x; /* source x */
> + __s32 y; /* source y */
> + __s32 width; /* rect width */
> + __s32 height; /* rect height */
> +};
> +
> +#define XENFB_OUT_EVENT_SIZE 40
> +
> +union xenfb_out_event
> +{
> + __u8 type;
> + struct xenfb_update update;
> + char pad[XENFB_OUT_EVENT_SIZE];
> +};
> +
> +/* In events (backend -> frontend) */
> +
> +/*
> + * Frontends should ignore unknown in events.
> + * No in events currently defined.
> + */
> +
> +#define XENFB_IN_EVENT_SIZE 40
> +
> +union xenfb_in_event
> +{
> + __u8 type;
> + char pad[XENFB_IN_EVENT_SIZE];
> +};
> +
> +/* shared page */
> +
> +#define XENFB_IN_RING_SIZE 1024
> +#define XENFB_IN_RING_LEN (XENFB_IN_RING_SIZE / XENFB_IN_EVENT_SIZE)
> +#define XENFB_IN_RING_OFFS 1024
> +#define XENFB_IN_RING(page) \
> + ((union xenfb_in_event *)((char *)(page) + XENFB_IN_RING_OFFS))
> +#define XENFB_IN_RING_REF(page, idx) \
> + (XENFB_IN_RING((page))[(idx) % XENFB_IN_RING_LEN])
> +
> +#define XENFB_OUT_RING_SIZE 2048
> +#define XENFB_OUT_RING_LEN (XENFB_OUT_RING_SIZE / XENFB_OUT_EVENT_SIZE)
> +#define XENFB_OUT_RING_OFFS (XENFB_IN_RING_OFFS + XENFB_IN_RING_SIZE)
> +#define XENFB_OUT_RING(page) \
> + ((union xenfb_out_event *)((char *)(page) + XENFB_OUT_RING_OFFS))
> +#define XENFB_OUT_RING_REF(page, idx) \
> + (XENFB_OUT_RING((page))[(idx) % XENFB_OUT_RING_LEN])
> +
> +struct xenfb_page
> +{
> + __u32 in_cons, in_prod;
> + __u32 out_cons, out_prod;
> +
> + __s32 width; /* the width of the framebuffer (in pixels) */
> + __s32 height; /* the height of the framebuffer (in pixels) */
> + __u32 line_length; /* the length of a row of pixels (in bytes) */
> + __u32 mem_length; /* the length of the framebuffer (in bytes) */
> + __u8 depth; /* the depth of a pixel (in bits) */
> +
> + /*
> + * Framebuffer page directory
> + *
> + * Each directory page holds PAGE_SIZE / sizeof(*pd)
> + * framebuffer pages, and can thus map up to PAGE_SIZE *
> + * PAGE_SIZE / sizeof(*pd) bytes. With PAGE_SIZE == 4096 and
> + * sizeof(unsigned long) == 4, that's 4 Megs. Two directory
> + * pages should be enough for a while.
> + */
> + unsigned long pd[2];
> +};
> +
> +/*
> + * Wart: xenkbd needs to know resolution. Put it here until a better
> + * solution is found, but don't leak it to the backend.
> + */
> +#ifdef __KERNEL__
> +#define XENFB_WIDTH 800
> +#define XENFB_HEIGHT 600
> +#define XENFB_DEPTH 32
> +#endif
> +
> +#endif
> diff -r 2773c39df9a6 xen/include/public/io/kbdif.h
> --- /dev/null Thu Jan 01 00:00:00 1970 +0000
> +++ b/xen/include/public/io/kbdif.h Wed Nov 29 17:35:42 2006 +0100
> @@ -0,0 +1,108 @@
> +/*
> + * kbdif.h -- Xen virtual keyboard/mouse
> + *
> + * Copyright (C) 2005 Anthony Liguori <aliguori@xxxxxxxxxx>
> + * Copyright (C) 2006 Red Hat, Inc., Markus Armbruster <armbru@xxxxxxxxxx>
> + *
> + * This file is subject to the terms and conditions of the GNU General
> Public
> + * License. See the file COPYING in the main directory of this archive for
> + * more details.
> + */
> +
> +#ifndef __XEN_PUBLIC_IO_KBDIF_H__
> +#define __XEN_PUBLIC_IO_KBDIF_H__
> +
> +#include <asm/types.h>
> +
> +/* In events (backend -> frontend) */
> +
> +/*
> + * Frontends should ignore unknown in events.
> + */
> +
> +/* Pointer movement event */
> +#define XENKBD_TYPE_MOTION 1
> +/* Event type 2 currently not used */
> +/* Key event (includes pointer buttons) */
> +#define XENKBD_TYPE_KEY 3
> +/*
> + * Pointer position event
> + * Capable backend sets feature-abs-pointer in xenstore.
> + * Frontend requests ot instead of XENKBD_TYPE_MOTION by setting
> + * request-abs-update in xenstore.
> + */
> +#define XENKBD_TYPE_POS 4
> +
> +struct xenkbd_motion
> +{
> + __u8 type; /* XENKBD_TYPE_MOTION */
> + __s32 rel_x; /* relative X motion */
> + __s32 rel_y; /* relative Y motion */
> +};
> +
> +struct xenkbd_key
> +{
> + __u8 type; /* XENKBD_TYPE_KEY */
> + __u8 pressed; /* 1 if pressed; 0 otherwise */
> + __u32 keycode; /* KEY_* from linux/input.h */
> +};
> +
> +struct xenkbd_position
> +{
> + __u8 type; /* XENKBD_TYPE_POS */
> + __s32 abs_x; /* absolute X position (in FB pixels) */
> + __s32 abs_y; /* absolute Y position (in FB pixels) */
> +};
> +
> +#define XENKBD_IN_EVENT_SIZE 40
> +
> +union xenkbd_in_event
> +{
> + __u8 type;
> + struct xenkbd_motion motion;
> + struct xenkbd_key key;
> + struct xenkbd_position pos;
> + char pad[XENKBD_IN_EVENT_SIZE];
> +};
> +
> +/* Out events (frontend -> backend) */
> +
> +/*
> + * Out events may be sent only when requested by backend, and receipt
> + * of an unknown out event is an error.
> + * No out events currently defined.
> + */
> +
> +#define XENKBD_OUT_EVENT_SIZE 40
> +
> +union xenkbd_out_event
> +{
> + __u8 type;
> + char pad[XENKBD_OUT_EVENT_SIZE];
> +};
> +
> +/* shared page */
> +
> +#define XENKBD_IN_RING_SIZE 2048
> +#define XENKBD_IN_RING_LEN (XENKBD_IN_RING_SIZE / XENKBD_IN_EVENT_SIZE)
> +#define XENKBD_IN_RING_OFFS 1024
> +#define XENKBD_IN_RING(page) \
> + ((union xenkbd_in_event *)((char *)(page) + XENKBD_IN_RING_OFFS))
> +#define XENKBD_IN_RING_REF(page, idx) \
> + (XENKBD_IN_RING((page))[(idx) % XENKBD_IN_RING_LEN])
> +
> +#define XENKBD_OUT_RING_SIZE 1024
> +#define XENKBD_OUT_RING_LEN (XENKBD_OUT_RING_SIZE / XENKBD_OUT_EVENT_SIZE)
> +#define XENKBD_OUT_RING_OFFS (XENKBD_IN_RING_OFFS + XENKBD_IN_RING_SIZE)
> +#define XENKBD_OUT_RING(page) \
> + ((union xenkbd_out_event *)((char *)(page) + XENKBD_OUT_RING_OFFS))
> +#define XENKBD_OUT_RING_REF(page, idx) \
> + (XENKBD_OUT_RING((page))[(idx) % XENKBD_OUT_RING_LEN])
> +
> +struct xenkbd_page
> +{
> + __u32 in_cons, in_prod;
> + __u32 out_cons, out_prod;
> +};
> +
> +#endif
> diff -r 2773c39df9a6 linux-2.6-xen-sparse/drivers/char/tty_io.c
> --- a/linux-2.6-xen-sparse/drivers/char/tty_io.c Wed Nov 29 12:16:19
> 2006 +0000
> +++ /dev/null Thu Jan 01 00:00:00 1970 +0000
> @@ -1,3264 +0,0 @@
> -/*
> - * linux/drivers/char/tty_io.c
> - *
> - * Copyright (C) 1991, 1992 Linus Torvalds
> - */
> -
> -/*
> - * 'tty_io.c' gives an orthogonal feeling to tty's, be they consoles
> - * or rs-channels. It also implements echoing, cooked mode etc.
> - *
> - * Kill-line thanks to John T Kohl, who also corrected VMIN = VTIME = 0.
> - *
> - * Modified by Theodore Ts'o, 9/14/92, to dynamically allocate the
> - * tty_struct and tty_queue structures. Previously there was an array
> - * of 256 tty_struct's which was statically allocated, and the
> - * tty_queue structures were allocated at boot time. Both are now
> - * dynamically allocated only when the tty is open.
> - *
> - * Also restructured routines so that there is more of a separation
> - * between the high-level tty routines (tty_io.c and tty_ioctl.c) and
> - * the low-level tty routines (serial.c, pty.c, console.c). This
> - * makes for cleaner and more compact code. -TYT, 9/17/92
> - *
> - * Modified by Fred N. van Kempen, 01/29/93, to add line disciplines
> - * which can be dynamically activated and de-activated by the line
> - * discipline handling modules (like SLIP).
> - *
> - * NOTE: pay no attention to the line discipline code (yet); its
> - * interface is still subject to change in this version...
> - * -- TYT, 1/31/92
> - *
> - * Added functionality to the OPOST tty handling. No delays, but all
> - * other bits should be there.
> - * -- Nick Holloway <alfie@xxxxxxxxxxxxxxxxx>, 27th May 1993.
> - *
> - * Rewrote canonical mode and added more termios flags.
> - * -- julian@xxxxxxxxxxxxxxxxxxxxxx (J. Cowley), 13Jan94
> - *
> - * Reorganized FASYNC support so mouse code can share it.
> - * -- ctm@xxxxxxxx, 9Sep95
> - *
> - * New TIOCLINUX variants added.
> - * -- mj@xxxxxxxxxxxxxxxxx, 19-Nov-95
> - *
> - * Restrict vt switching via ioctl()
> - * -- grif@xxxxxxxxxx, 5-Dec-95
> - *
> - * Move console and virtual terminal code to more appropriate files,
> - * implement CONFIG_VT and generalize console device interface.
> - * -- Marko Kohtala <Marko.Kohtala@xxxxxx>, March 97
> - *
> - * Rewrote init_dev and release_dev to eliminate races.
> - * -- Bill Hawes <whawes@xxxxxxxx>, June 97
> - *
> - * Added devfs support.
> - * -- C. Scott Ananian <cananian@xxxxxxxxxxxxxxxxxxxx>, 13-Jan-1998
> - *
> - * Added support for a Unix98-style ptmx device.
> - * -- C. Scott Ananian <cananian@xxxxxxxxxxxxxxxxxxxx>, 14-Jan-1998
> - *
> - * Reduced memory usage for older ARM systems
> - * -- Russell King <rmk@xxxxxxxxxxxxxxxx>
> - *
> - * Move do_SAK() into process context. Less stack use in devfs functions.
> - * alloc_tty_struct() always uses kmalloc() -- Andrew Morton
> <andrewm@xxxxxxxxxx> 17Mar01
> - */
> -
> -#include <linux/config.h>
> -#include <linux/types.h>
> -#include <linux/major.h>
> -#include <linux/errno.h>
> -#include <linux/signal.h>
> -#include <linux/fcntl.h>
> -#include <linux/sched.h>
> -#include <linux/interrupt.h>
> -#include <linux/tty.h>
> -#include <linux/tty_driver.h>
> -#include <linux/tty_flip.h>
> -#include <linux/devpts_fs.h>
> -#include <linux/file.h>
> -#include <linux/console.h>
> -#include <linux/timer.h>
> -#include <linux/ctype.h>
> -#include <linux/kd.h>
> -#include <linux/mm.h>
> -#include <linux/string.h>
> -#include <linux/slab.h>
> -#include <linux/poll.h>
> -#include <linux/proc_fs.h>
> -#include <linux/init.h>
> -#include <linux/module.h>
> -#include <linux/smp_lock.h>
> -#include <linux/device.h>
> -#include <linux/idr.h>
> -#include <linux/wait.h>
> -#include <linux/bitops.h>
> -#include <linux/delay.h>
> -
> -#include <asm/uaccess.h>
> -#include <asm/system.h>
> -
> -#include <linux/kbd_kern.h>
> -#include <linux/vt_kern.h>
> -#include <linux/selection.h>
> -#include <linux/devfs_fs_kernel.h>
> -
> -#include <linux/kmod.h>
> -
> -#undef TTY_DEBUG_HANGUP
> -
> -#define TTY_PARANOIA_CHECK 1
> -#define CHECK_TTY_COUNT 1
> -
> -struct termios tty_std_termios = { /* for the benefit of tty drivers */
> - .c_iflag = ICRNL | IXON,
> - .c_oflag = OPOST | ONLCR,
> - .c_cflag = B38400 | CS8 | CREAD | HUPCL,
> - .c_lflag = ISIG | ICANON | ECHO | ECHOE | ECHOK |
> - ECHOCTL | ECHOKE | IEXTEN,
> - .c_cc = INIT_C_CC
> -};
> -
> -EXPORT_SYMBOL(tty_std_termios);
> -
> -/* This list gets poked at by procfs and various bits of boot up code. This
> - could do with some rationalisation such as pulling the tty proc function
> - into this file */
> -
> -LIST_HEAD(tty_drivers); /* linked list of tty drivers */
> -
> -/* Semaphore to protect creating and releasing a tty. This is shared with
> - vt.c for deeply disgusting hack reasons */
> -DECLARE_MUTEX(tty_sem);
> -
> -int console_use_vt = 1;
> -
> -#ifdef CONFIG_UNIX98_PTYS
> -extern struct tty_driver *ptm_driver; /* Unix98 pty masters; for
> /dev/ptmx */
> -extern int pty_limit; /* Config limit on Unix98 ptys */
> -static DEFINE_IDR(allocated_ptys);
> -static DECLARE_MUTEX(allocated_ptys_lock);
> -static int ptmx_open(struct inode *, struct file *);
> -#endif
> -
> -extern void disable_early_printk(void);
> -
> -static void initialize_tty_struct(struct tty_struct *tty);
> -
> -static ssize_t tty_read(struct file *, char __user *, size_t, loff_t *);
> -static ssize_t tty_write(struct file *, const char __user *, size_t, loff_t
> *);
> -ssize_t redirected_tty_write(struct file *, const char __user *, size_t,
> loff_t *);
> -static unsigned int tty_poll(struct file *, poll_table *);
> -static int tty_open(struct inode *, struct file *);
> -static int tty_release(struct inode *, struct file *);
> -int tty_ioctl(struct inode * inode, struct file * file,
> - unsigned int cmd, unsigned long arg);
> -static int tty_fasync(int fd, struct file * filp, int on);
> -static void release_mem(struct tty_struct *tty, int idx);
> -
> -
> -static struct tty_struct *alloc_tty_struct(void)
> -{
> - struct tty_struct *tty;
> -
> - tty = kmalloc(sizeof(struct tty_struct), GFP_KERNEL);
> - if (tty)
> - memset(tty, 0, sizeof(struct tty_struct));
> - return tty;
> -}
> -
> -static void tty_buffer_free_all(struct tty_struct *);
> -
> -static inline void free_tty_struct(struct tty_struct *tty)
> -{
> - kfree(tty->write_buf);
> - tty_buffer_free_all(tty);
> - kfree(tty);
> -}
> -
> -#define TTY_NUMBER(tty) ((tty)->index + (tty)->driver->name_base)
> -
> -char *tty_name(struct tty_struct *tty, char *buf)
> -{
> - if (!tty) /* Hmm. NULL pointer. That's fun. */
> - strcpy(buf, "NULL tty");
> - else
> - strcpy(buf, tty->name);
> - return buf;
> -}
> -
> -EXPORT_SYMBOL(tty_name);
> -
> -int tty_paranoia_check(struct tty_struct *tty, struct inode *inode,
> - const char *routine)
> -{
> -#ifdef TTY_PARANOIA_CHECK
> - if (!tty) {
> - printk(KERN_WARNING
> - "null TTY for (%d:%d) in %s\n",
> - imajor(inode), iminor(inode), routine);
> - return 1;
> - }
> - if (tty->magic != TTY_MAGIC) {
> - printk(KERN_WARNING
> - "bad magic number for tty struct (%d:%d) in %s\n",
> - imajor(inode), iminor(inode), routine);
> - return 1;
> - }
> -#endif
> - return 0;
> -}
> -
> -static int check_tty_count(struct tty_struct *tty, const char *routine)
> -{
> -#ifdef CHECK_TTY_COUNT
> - struct list_head *p;
> - int count = 0;
> -
> - file_list_lock();
> - list_for_each(p, &tty->tty_files) {
> - count++;
> - }
> - file_list_unlock();
> - if (tty->driver->type == TTY_DRIVER_TYPE_PTY &&
> - tty->driver->subtype == PTY_TYPE_SLAVE &&
> - tty->link && tty->link->count)
> - count++;
> - if (tty->count != count) {
> - printk(KERN_WARNING "Warning: dev (%s) tty->count(%d) "
> - "!= #fd's(%d) in %s\n",
> - tty->name, tty->count, count, routine);
> - return count;
> - }
> -#endif
> - return 0;
> -}
> -
> -/*
> - * Tty buffer allocation management
> - */
> -
> -static void tty_buffer_free_all(struct tty_struct *tty)
> -{
> - struct tty_buffer *thead;
> - while((thead = tty->buf.head) != NULL) {
> - tty->buf.head = thead->next;
> - kfree(thead);
> - }
> - while((thead = tty->buf.free) != NULL) {
> - tty->buf.free = thead->next;
> - kfree(thead);
> - }
> - tty->buf.tail = NULL;
> -}
> -
> -static void tty_buffer_init(struct tty_struct *tty)
> -{
> - spin_lock_init(&tty->buf.lock);
> - tty->buf.head = NULL;
> - tty->buf.tail = NULL;
> - tty->buf.free = NULL;
> -}
> -
> -static struct tty_buffer *tty_buffer_alloc(size_t size)
> -{
> - struct tty_buffer *p = kmalloc(sizeof(struct tty_buffer) + 2 * size,
> GFP_ATOMIC);
> - if(p == NULL)
> - return NULL;
> - p->used = 0;
> - p->size = size;
> - p->next = NULL;
> - p->active = 0;
> - p->commit = 0;
> - p->read = 0;
> - p->char_buf_ptr = (char *)(p->data);
> - p->flag_buf_ptr = (unsigned char *)p->char_buf_ptr + size;
> -/* printk("Flip create %p\n", p); */
> - return p;
> -}
> -
> -/* Must be called with the tty_read lock held. This needs to acquire strategy
> - code to decide if we should kfree or relink a given expired buffer */
> -
> -static void tty_buffer_free(struct tty_struct *tty, struct tty_buffer *b)
> -{
> - /* Dumb strategy for now - should keep some stats */
> -/* printk("Flip dispose %p\n", b); */
> - if(b->size >= 512)
> - kfree(b);
> - else {
> - b->next = tty->buf.free;
> - tty->buf.free = b;
> - }
> -}
> -
> -static struct tty_buffer *tty_buffer_find(struct tty_struct *tty, size_t
> size)
> -{
> - struct tty_buffer **tbh = &tty->buf.free;
> - while((*tbh) != NULL) {
> - struct tty_buffer *t = *tbh;
> - if(t->size >= size) {
> - *tbh = t->next;
> - t->next = NULL;
> - t->used = 0;
> - t->commit = 0;
> - t->read = 0;
> - /* DEBUG ONLY */
> -/* memset(t->data, '*', size); */
> -/* printk("Flip recycle %p\n", t); */
> - return t;
> - }
> - tbh = &((*tbh)->next);
> - }
> - /* Round the buffer size out */
> - size = (size + 0xFF) & ~ 0xFF;
> - return tty_buffer_alloc(size);
> - /* Should possibly check if this fails for the largest buffer we
> - have queued and recycle that ? */
> -}
> -
> -int tty_buffer_request_room(struct tty_struct *tty, size_t size)
> -{
> - struct tty_buffer *b, *n;
> - int left;
> - unsigned long flags;
> -
> - spin_lock_irqsave(&tty->buf.lock, flags);
> -
> - /* OPTIMISATION: We could keep a per tty "zero" sized buffer to
> - remove this conditional if its worth it. This would be invisible
> - to the callers */
> - if ((b = tty->buf.tail) != NULL) {
> - left = b->size - b->used;
> - b->active = 1;
> - } else
> - left = 0;
> -
> - if (left < size) {
> - /* This is the slow path - looking for new buffers to use */
> - if ((n = tty_buffer_find(tty, size)) != NULL) {
> - if (b != NULL) {
> - b->next = n;
> - b->active = 0;
> - b->commit = b->used;
> - } else
> - tty->buf.head = n;
> - tty->buf.tail = n;
> - n->active = 1;
> - } else
> - size = left;
> - }
> -
> - spin_unlock_irqrestore(&tty->buf.lock, flags);
> - return size;
> -}
> -
> -EXPORT_SYMBOL_GPL(tty_buffer_request_room);
> -
> -int tty_insert_flip_string(struct tty_struct *tty, unsigned char *chars,
> size_t size)
> -{
> - int copied = 0;
> - do {
> - int space = tty_buffer_request_room(tty, size - copied);
> - struct tty_buffer *tb = tty->buf.tail;
> - /* If there is no space then tb may be NULL */
> - if(unlikely(space == 0))
> - break;
> - memcpy(tb->char_buf_ptr + tb->used, chars, space);
> - memset(tb->flag_buf_ptr + tb->used, TTY_NORMAL, space);
> - tb->used += space;
> - copied += space;
> - chars += space;
> -/* printk("Flip insert %d.\n", space); */
> - }
> - /* There is a small chance that we need to split the data over
> - several buffers. If this is the case we must loop */
> - while (unlikely(size > copied));
> - return copied;
> -}
> -
> -EXPORT_SYMBOL_GPL(tty_insert_flip_string);
> -
> -int tty_insert_flip_string_flags(struct tty_struct *tty, unsigned char
> *chars, char *flags, size_t size)
> -{
> - int copied = 0;
> - do {
> - int space = tty_buffer_request_room(tty, size - copied);
> - struct tty_buffer *tb = tty->buf.tail;
> - /* If there is no space then tb may be NULL */
> - if(unlikely(space == 0))
> - break;
> - memcpy(tb->char_buf_ptr + tb->used, chars, space);
> - memcpy(tb->flag_buf_ptr + tb->used, flags, space);
> - tb->used += space;
> - copied += space;
> - chars += space;
> - flags += space;
> - }
> - /* There is a small chance that we need to split the data over
> - several buffers. If this is the case we must loop */
> - while (unlikely(size > copied));
> - return copied;
> -}
> -
> -EXPORT_SYMBOL_GPL(tty_insert_flip_string_flags);
> -
> -
> -/*
> - * Prepare a block of space in the buffer for data. Returns the length
> - * available and buffer pointer to the space which is now allocated and
> - * accounted for as ready for normal characters. This is used for drivers
> - * that need their own block copy routines into the buffer. There is no
> - * guarantee the buffer is a DMA target!
> - */
> -
> -int tty_prepare_flip_string(struct tty_struct *tty, unsigned char **chars,
> size_t size)
> -{
> - int space = tty_buffer_request_room(tty, size);
> - if (likely(space)) {
> - struct tty_buffer *tb = tty->buf.tail;
> - *chars = tb->char_buf_ptr + tb->used;
> - memset(tb->flag_buf_ptr + tb->used, TTY_NORMAL, space);
> - tb->used += space;
> - }
> - return space;
> -}
> -
> -EXPORT_SYMBOL_GPL(tty_prepare_flip_string);
> -
> -/*
> - * Prepare a block of space in the buffer for data. Returns the length
> - * available and buffer pointer to the space which is now allocated and
> - * accounted for as ready for characters. This is used for drivers
> - * that need their own block copy routines into the buffer. There is no
> - * guarantee the buffer is a DMA target!
> - */
> -
> -int tty_prepare_flip_string_flags(struct tty_struct *tty, unsigned char
> **chars, char **flags, size_t size)
> -{
> - int space = tty_buffer_request_room(tty, size);
> - if (likely(space)) {
> - struct tty_buffer *tb = tty->buf.tail;
> - *chars = tb->char_buf_ptr + tb->used;
> - *flags = tb->flag_buf_ptr + tb->used;
> - tb->used += space;
> - }
> - return space;
> -}
> -
> -EXPORT_SYMBOL_GPL(tty_prepare_flip_string_flags);
> -
> -
> -
> -/*
> - * This is probably overkill for real world processors but
> - * they are not on hot paths so a little discipline won't do
> - * any harm.
> - */
> -
> -static void tty_set_termios_ldisc(struct tty_struct *tty, int num)
> -{
> - down(&tty->termios_sem);
> - tty->termios->c_line = num;
> - up(&tty->termios_sem);
> -}
> -
> -/*
> - * This guards the refcounted line discipline lists. The lock
> - * must be taken with irqs off because there are hangup path
> - * callers who will do ldisc lookups and cannot sleep.
> - */
> -
> -static DEFINE_SPINLOCK(tty_ldisc_lock);
> -static DECLARE_WAIT_QUEUE_HEAD(tty_ldisc_wait);
> -static struct tty_ldisc tty_ldiscs[NR_LDISCS]; /* line disc dispatch
> table */
> -
> -int tty_register_ldisc(int disc, struct tty_ldisc *new_ldisc)
> -{
> - unsigned long flags;
> - int ret = 0;
> -
> - if (disc < N_TTY || disc >= NR_LDISCS)
> - return -EINVAL;
> -
> - spin_lock_irqsave(&tty_ldisc_lock, flags);
> - tty_ldiscs[disc] = *new_ldisc;
> - tty_ldiscs[disc].num = disc;
> - tty_ldiscs[disc].flags |= LDISC_FLAG_DEFINED;
> - tty_ldiscs[disc].refcount = 0;
> - spin_unlock_irqrestore(&tty_ldisc_lock, flags);
> -
> - return ret;
> -}
> -EXPORT_SYMBOL(tty_register_ldisc);
> -
> -int tty_unregister_ldisc(int disc)
> -{
> - unsigned long flags;
> - int ret = 0;
> -
> - if (disc < N_TTY || disc >= NR_LDISCS)
> - return -EINVAL;
> -
> - spin_lock_irqsave(&tty_ldisc_lock, flags);
> - if (tty_ldiscs[disc].refcount)
> - ret = -EBUSY;
> - else
> - tty_ldiscs[disc].flags &= ~LDISC_FLAG_DEFINED;
> - spin_unlock_irqrestore(&tty_ldisc_lock, flags);
> -
> - return ret;
> -}
> -EXPORT_SYMBOL(tty_unregister_ldisc);
> -
> -struct tty_ldisc *tty_ldisc_get(int disc)
> -{
> - unsigned long flags;
> - struct tty_ldisc *ld;
> -
> - if (disc < N_TTY || disc >= NR_LDISCS)
> - return NULL;
> -
> - spin_lock_irqsave(&tty_ldisc_lock, flags);
> -
> - ld = &tty_ldiscs[disc];
> - /* Check the entry is defined */
> - if(ld->flags & LDISC_FLAG_DEFINED)
> - {
> - /* If the module is being unloaded we can't use it */
> - if (!try_module_get(ld->owner))
> - ld = NULL;
> - else /* lock it */
> - ld->refcount++;
> - }
> - else
> - ld = NULL;
> - spin_unlock_irqrestore(&tty_ldisc_lock, flags);
> - return ld;
> -}
> -
> -EXPORT_SYMBOL_GPL(tty_ldisc_get);
> -
> -void tty_ldisc_put(int disc)
> -{
> - struct tty_ldisc *ld;
> - unsigned long flags;
> -
> - if (disc < N_TTY || disc >= NR_LDISCS)
> - BUG();
> -
> - spin_lock_irqsave(&tty_ldisc_lock, flags);
> - ld = &tty_ldiscs[disc];
> - if(ld->refcount == 0)
> - BUG();
> - ld->refcount --;
> - module_put(ld->owner);
> - spin_unlock_irqrestore(&tty_ldisc_lock, flags);
> -}
> -
> -EXPORT_SYMBOL_GPL(tty_ldisc_put);
> -
> -static void tty_ldisc_assign(struct tty_struct *tty, struct tty_ldisc *ld)
> -{
> - tty->ldisc = *ld;
> - tty->ldisc.refcount = 0;
> -}
> -
> -/**
> - * tty_ldisc_try - internal helper
> - * @tty: the tty
> - *
> - * Make a single attempt to grab and bump the refcount on
> - * the tty ldisc. Return 0 on failure or 1 on success. This is
> - * used to implement both the waiting and non waiting versions
> - * of tty_ldisc_ref
> - */
> -
> -static int tty_ldisc_try(struct tty_struct *tty)
> -{
> - unsigned long flags;
> - struct tty_ldisc *ld;
> - int ret = 0;
> -
> - spin_lock_irqsave(&tty_ldisc_lock, flags);
> - ld = &tty->ldisc;
> - if(test_bit(TTY_LDISC, &tty->flags))
> - {
> - ld->refcount++;
> - ret = 1;
> - }
> - spin_unlock_irqrestore(&tty_ldisc_lock, flags);
> - return ret;
> -}
> -
> -/**
> - * tty_ldisc_ref_wait - wait for the tty ldisc
> - * @tty: tty device
> - *
> - * Dereference the line discipline for the terminal and take a
> - * reference to it. If the line discipline is in flux then
> - * wait patiently until it changes.
> - *
> - * Note: Must not be called from an IRQ/timer context. The caller
> - * must also be careful not to hold other locks that will deadlock
> - * against a discipline change, such as an existing ldisc reference
> - * (which we check for)
> - */
> -
> -struct tty_ldisc *tty_ldisc_ref_wait(struct tty_struct *tty)
> -{
> - /* wait_event is a macro */
> - wait_event(tty_ldisc_wait, tty_ldisc_try(tty));
> - if(tty->ldisc.refcount == 0)
> - printk(KERN_ERR "tty_ldisc_ref_wait\n");
> - return &tty->ldisc;
> -}
> -
> -EXPORT_SYMBOL_GPL(tty_ldisc_ref_wait);
> -
> -/**
> - * tty_ldisc_ref - get the tty ldisc
> - * @tty: tty device
> - *
> - * Dereference the line discipline for the terminal and take a
> - * reference to it. If the line discipline is in flux then
> - * return NULL. Can be called from IRQ and timer functions.
> - */
> -
> -struct tty_ldisc *tty_ldisc_ref(struct tty_struct *tty)
> -{
> - if(tty_ldisc_try(tty))
> - return &tty->ldisc;
> - return NULL;
> -}
> -
> -EXPORT_SYMBOL_GPL(tty_ldisc_ref);
> -
> -/**
> - * tty_ldisc_deref - free a tty ldisc reference
> - * @ld: reference to free up
> - *
> - * Undoes the effect of tty_ldisc_ref or tty_ldisc_ref_wait. May
> - * be called in IRQ context.
> - */
> -
> -void tty_ldisc_deref(struct tty_ldisc *ld)
> -{
> - unsigned long flags;
> -
> - if(ld == NULL)
> - BUG();
> -
> - spin_lock_irqsave(&tty_ldisc_lock, flags);
> - if(ld->refcount == 0)
> - printk(KERN_ERR "tty_ldisc_deref: no references.\n");
> - else
> - ld->refcount--;
> - if(ld->refcount == 0)
> - wake_up(&tty_ldisc_wait);
> - spin_unlock_irqrestore(&tty_ldisc_lock, flags);
> -}
> -
> -EXPORT_SYMBOL_GPL(tty_ldisc_deref);
> -
> -/**
> - * tty_ldisc_enable - allow ldisc use
> - * @tty: terminal to activate ldisc on
> - *
> - * Set the TTY_LDISC flag when the line discipline can be called
> - * again. Do neccessary wakeups for existing sleepers.
> - *
> - * Note: nobody should set this bit except via this function. Clearing
> - * directly is allowed.
> - */
> -
> -static void tty_ldisc_enable(struct tty_struct *tty)
> -{
> - set_bit(TTY_LDISC, &tty->flags);
> - wake_up(&tty_ldisc_wait);
> -}
> -
> -/**
> - * tty_set_ldisc - set line discipline
> - * @tty: the terminal to set
> - * @ldisc: the line discipline
> - *
> - * Set the discipline of a tty line. Must be called from a process
> - * context.
> - */
> -
> -static int tty_set_ldisc(struct tty_struct *tty, int ldisc)
> -{
> - int retval = 0;
> - struct tty_ldisc o_ldisc;
> - char buf[64];
> - int work;
> - unsigned long flags;
> - struct tty_ldisc *ld;
> - struct tty_struct *o_tty;
> -
> - if ((ldisc < N_TTY) || (ldisc >= NR_LDISCS))
> - return -EINVAL;
> -
> -restart:
> -
> - ld = tty_ldisc_get(ldisc);
> - /* Eduardo Blanco <ejbs@xxxxxxxxxxxx> */
> - /* Cyrus Durgin <cider@xxxxxxxxxxxxx> */
> - if (ld == NULL) {
> - request_module("tty-ldisc-%d", ldisc);
> - ld = tty_ldisc_get(ldisc);
> - }
> - if (ld == NULL)
> - return -EINVAL;
> -
> - /*
> - * No more input please, we are switching. The new ldisc
> - * will update this value in the ldisc open function
> - */
> -
> - tty->receive_room = 0;
> -
> - /*
> - * Problem: What do we do if this blocks ?
> - */
> -
> - tty_wait_until_sent(tty, 0);
> -
> - if (tty->ldisc.num == ldisc) {
> - tty_ldisc_put(ldisc);
> - return 0;
> - }
> -
> - o_ldisc = tty->ldisc;
> - o_tty = tty->link;
> -
> - /*
> - * Make sure we don't change while someone holds a
> - * reference to the line discipline. The TTY_LDISC bit
> - * prevents anyone taking a reference once it is clear.
> - * We need the lock to avoid racing reference takers.
> - */
> -
> - spin_lock_irqsave(&tty_ldisc_lock, flags);
> - if (tty->ldisc.refcount || (o_tty && o_tty->ldisc.refcount)) {
> - if(tty->ldisc.refcount) {
> - /* Free the new ldisc we grabbed. Must drop the lock
> - first. */
> - spin_unlock_irqrestore(&tty_ldisc_lock, flags);
> - tty_ldisc_put(ldisc);
> - /*
> - * There are several reasons we may be busy, including
> - * random momentary I/O traffic. We must therefore
> - * retry. We could distinguish between blocking ops
> - * and retries if we made tty_ldisc_wait() smarter. That
> - * is up for discussion.
> - */
> - if (wait_event_interruptible(tty_ldisc_wait,
> tty->ldisc.refcount == 0) < 0)
> - return -ERESTARTSYS;
> - goto restart;
> - }
> - if(o_tty && o_tty->ldisc.refcount) {
> - spin_unlock_irqrestore(&tty_ldisc_lock, flags);
> - tty_ldisc_put(ldisc);
> - if (wait_event_interruptible(tty_ldisc_wait,
> o_tty->ldisc.refcount == 0) < 0)
> - return -ERESTARTSYS;
> - goto restart;
> - }
> - }
> -
> - /* if the TTY_LDISC bit is set, then we are racing against another
> ldisc change */
> -
> - if (!test_bit(TTY_LDISC, &tty->flags)) {
> - spin_unlock_irqrestore(&tty_ldisc_lock, flags);
> - tty_ldisc_put(ldisc);
> - ld = tty_ldisc_ref_wait(tty);
> - tty_ldisc_deref(ld);
> - goto restart;
> - }
> -
> - clear_bit(TTY_LDISC, &tty->flags);
> - clear_bit(TTY_DONT_FLIP, &tty->flags);
> - if (o_tty) {
> - clear_bit(TTY_LDISC, &o_tty->flags);
> - clear_bit(TTY_DONT_FLIP, &o_tty->flags);
> - }
> - spin_unlock_irqrestore(&tty_ldisc_lock, flags);
> -
> - /*
> - * From this point on we know nobody has an ldisc
> - * usage reference, nor can they obtain one until
> - * we say so later on.
> - */
> -
> - work = cancel_delayed_work(&tty->buf.work);
> - /*
> - * Wait for ->hangup_work and ->buf.work handlers to terminate
> - */
> -
> - flush_scheduled_work();
> - /* Shutdown the current discipline. */
> - if (tty->ldisc.close)
> - (tty->ldisc.close)(tty);
> -
> - /* Now set up the new line discipline. */
> - tty_ldisc_assign(tty, ld);
> - tty_set_termios_ldisc(tty, ldisc);
> - if (tty->ldisc.open)
> - retval = (tty->ldisc.open)(tty);
> - if (retval < 0) {
> - tty_ldisc_put(ldisc);
> - /* There is an outstanding reference here so this is safe */
> - tty_ldisc_assign(tty, tty_ldisc_get(o_ldisc.num));
> - tty_set_termios_ldisc(tty, tty->ldisc.num);
> - if (tty->ldisc.open && (tty->ldisc.open(tty) < 0)) {
> - tty_ldisc_put(o_ldisc.num);
> - /* This driver is always present */
> - tty_ldisc_assign(tty, tty_ldisc_get(N_TTY));
> - tty_set_termios_ldisc(tty, N_TTY);
> - if (tty->ldisc.open) {
> - int r = tty->ldisc.open(tty);
> -
> - if (r < 0)
> - panic("Couldn't open N_TTY ldisc for "
> - "%s --- error %d.",
> - tty_name(tty, buf), r);
> - }
> - }
> - }
> - /* At this point we hold a reference to the new ldisc and a
> - a reference to the old ldisc. If we ended up flipping back
> - to the existing ldisc we have two references to it */
> -
> - if (tty->ldisc.num != o_ldisc.num && tty->driver->set_ldisc)
> - tty->driver->set_ldisc(tty);
> -
> - tty_ldisc_put(o_ldisc.num);
> -
> - /*
> - * Allow ldisc referencing to occur as soon as the driver
> - * ldisc callback completes.
> - */
> -
> - tty_ldisc_enable(tty);
> - if (o_tty)
> - tty_ldisc_enable(o_tty);
> -
> - /* Restart it in case no characters kick it off. Safe if
> - already running */
> - if (work)
> - schedule_delayed_work(&tty->buf.work, 1);
> - return retval;
> -}
> -
> -/*
> - * This routine returns a tty driver structure, given a device number
> - */
> -static struct tty_driver *get_tty_driver(dev_t device, int *index)
> -{
> - struct tty_driver *p;
> -
> - list_for_each_entry(p, &tty_drivers, tty_drivers) {
> - dev_t base = MKDEV(p->major, p->minor_start);
> - if (device < base || device >= base + p->num)
> - continue;
> - *index = device - base;
> - return p;
> - }
> - return NULL;
> -}
> -
> -/*
> - * If we try to write to, or set the state of, a terminal and we're
> - * not in the foreground, send a SIGTTOU. If the signal is blocked or
> - * ignored, go ahead and perform the operation. (POSIX 7.2)
> - */
> -int tty_check_change(struct tty_struct * tty)
> -{
> - if (current->signal->tty != tty)
> - return 0;
> - if (tty->pgrp <= 0) {
> - printk(KERN_WARNING "tty_check_change: tty->pgrp <= 0!\n");
> - return 0;
> - }
> - if (process_group(current) == tty->pgrp)
> - return 0;
> - if (is_ignored(SIGTTOU))
> - return 0;
> - if (is_orphaned_pgrp(process_group(current)))
> - return -EIO;
> - (void) kill_pg(process_group(current), SIGTTOU, 1);
> - return -ERESTARTSYS;
> -}
> -
> -EXPORT_SYMBOL(tty_check_change);
> -
> -static ssize_t hung_up_tty_read(struct file * file, char __user * buf,
> - size_t count, loff_t *ppos)
> -{
> - return 0;
> -}
> -
> -static ssize_t hung_up_tty_write(struct file * file, const char __user * buf,
> - size_t count, loff_t *ppos)
> -{
> - return -EIO;
> -}
> -
> -/* No kernel lock held - none needed ;) */
> -static unsigned int hung_up_tty_poll(struct file * filp, poll_table * wait)
> -{
> - return POLLIN | POLLOUT | POLLERR | POLLHUP | POLLRDNORM | POLLWRNORM;
> -}
> -
> -static int hung_up_tty_ioctl(struct inode * inode, struct file * file,
> - unsigned int cmd, unsigned long arg)
> -{
> - return cmd == TIOCSPGRP ? -ENOTTY : -EIO;
> -}
> -
> -static struct file_operations tty_fops = {
> - .llseek = no_llseek,
> - .read = tty_read,
> - .write = tty_write,
> - .poll = tty_poll,
> - .ioctl = tty_ioctl,
> - .open = tty_open,
> - .release = tty_release,
> - .fasync = tty_fasync,
> -};
> -
> -#ifdef CONFIG_UNIX98_PTYS
> -static struct file_operations ptmx_fops = {
> - .llseek = no_llseek,
> - .read = tty_read,
> - .write = tty_write,
> - .poll = tty_poll,
> - .ioctl = tty_ioctl,
> - .open = ptmx_open,
> - .release = tty_release,
> - .fasync = tty_fasync,
> -};
> -#endif
> -
> -static struct file_operations console_fops = {
> - .llseek = no_llseek,
> - .read = tty_read,
> - .write = redirected_tty_write,
> - .poll = tty_poll,
> - .ioctl = tty_ioctl,
> - .open = tty_open,
> - .release = tty_release,
> - .fasync = tty_fasync,
> -};
> -
> -static struct file_operations hung_up_tty_fops = {
> - .llseek = no_llseek,
> - .read = hung_up_tty_read,
> - .write = hung_up_tty_write,
> - .poll = hung_up_tty_poll,
> - .ioctl = hung_up_tty_ioctl,
> - .release = tty_release,
> -};
> -
> -static DEFINE_SPINLOCK(redirect_lock);
> -static struct file *redirect;
> -
> -/**
> - * tty_wakeup - request more data
> - * @tty: terminal
> - *
> - * Internal and external helper for wakeups of tty. This function
> - * informs the line discipline if present that the driver is ready
> - * to receive more output data.
> - */
> -
> -void tty_wakeup(struct tty_struct *tty)
> -{
> - struct tty_ldisc *ld;
> -
> - if (test_bit(TTY_DO_WRITE_WAKEUP, &tty->flags)) {
> - ld = tty_ldisc_ref(tty);
> - if(ld) {
> - if(ld->write_wakeup)
> - ld->write_wakeup(tty);
> - tty_ldisc_deref(ld);
> - }
> - }
> - wake_up_interruptible(&tty->write_wait);
> -}
> -
> -EXPORT_SYMBOL_GPL(tty_wakeup);
> -
> -/**
> - * tty_ldisc_flush - flush line discipline queue
> - * @tty: tty
> - *
> - * Flush the line discipline queue (if any) for this tty. If there
> - * is no line discipline active this is a no-op.
> - */
> -
> -void tty_ldisc_flush(struct tty_struct *tty)
> -{
> - struct tty_ldisc *ld = tty_ldisc_ref(tty);
> - if(ld) {
> - if(ld->flush_buffer)
> - ld->flush_buffer(tty);
> - tty_ldisc_deref(ld);
> - }
> -}
> -
> -EXPORT_SYMBOL_GPL(tty_ldisc_flush);
> -
> -/*
> - * This can be called by the "eventd" kernel thread. That is process
> synchronous,
> - * but doesn't hold any locks, so we need to make sure we have the
> appropriate
> - * locks for what we're doing..
> - */
> -static void do_tty_hangup(void *data)
> -{
> - struct tty_struct *tty = (struct tty_struct *) data;
> - struct file * cons_filp = NULL;
> - struct file *filp, *f = NULL;
> - struct task_struct *p;
> - struct tty_ldisc *ld;
> - int closecount = 0, n;
> -
> - if (!tty)
> - return;
> -
> - /* inuse_filps is protected by the single kernel lock */
> - lock_kernel();
> -
> - spin_lock(&redirect_lock);
> - if (redirect && redirect->private_data == tty) {
> - f = redirect;
> - redirect = NULL;
> - }
> - spin_unlock(&redirect_lock);
> -
> - check_tty_count(tty, "do_tty_hangup");
> - file_list_lock();
> - /* This breaks for file handles being sent over AF_UNIX sockets ? */
> - list_for_each_entry(filp, &tty->tty_files, f_u.fu_list) {
> - if (filp->f_op->write == redirected_tty_write)
> - cons_filp = filp;
> - if (filp->f_op->write != tty_write)
> - continue;
> - closecount++;
> - tty_fasync(-1, filp, 0); /* can't block */
> - filp->f_op = &hung_up_tty_fops;
> - }
> - file_list_unlock();
> -
> - /* FIXME! What are the locking issues here? This may me overdoing
> things..
> - * this question is especially important now that we've removed the
> irqlock. */
> -
> - ld = tty_ldisc_ref(tty);
> - if(ld != NULL) /* We may have no line discipline at this point */
> - {
> - if (ld->flush_buffer)
> - ld->flush_buffer(tty);
> - if (tty->driver->flush_buffer)
> - tty->driver->flush_buffer(tty);
> - if ((test_bit(TTY_DO_WRITE_WAKEUP, &tty->flags)) &&
> - ld->write_wakeup)
> - ld->write_wakeup(tty);
> - if (ld->hangup)
> - ld->hangup(tty);
> - }
> -
> - /* FIXME: Once we trust the LDISC code better we can wait here for
> - ldisc completion and fix the driver call race */
> -
> - wake_up_interruptible(&tty->write_wait);
> - wake_up_interruptible(&tty->read_wait);
> -
> - /*
> - * Shutdown the current line discipline, and reset it to
> - * N_TTY.
> - */
> - if (tty->driver->flags & TTY_DRIVER_RESET_TERMIOS)
> - {
> - down(&tty->termios_sem);
> - *tty->termios = tty->driver->init_termios;
> - up(&tty->termios_sem);
> - }
> -
> - /* Defer ldisc switch */
> - /* tty_deferred_ldisc_switch(N_TTY);
> -
> - This should get done automatically when the port closes and
> - tty_release is called */
> -
> - read_lock(&tasklist_lock);
> - if (tty->session > 0) {
> - do_each_task_pid(tty->session, PIDTYPE_SID, p) {
> - if (p->signal->tty == tty)
> - p->signal->tty = NULL;
> - if (!p->signal->leader)
> - continue;
> - send_group_sig_info(SIGHUP, SEND_SIG_PRIV, p);
> - send_group_sig_info(SIGCONT, SEND_SIG_PRIV, p);
> - if (tty->pgrp > 0)
> - p->signal->tty_old_pgrp = tty->pgrp;
> - } while_each_task_pid(tty->session, PIDTYPE_SID, p);
> - }
> - read_unlock(&tasklist_lock);
> -
> - tty->flags = 0;
> - tty->session = 0;
> - tty->pgrp = -1;
> - tty->ctrl_status = 0;
> - /*
> - * If one of the devices matches a console pointer, we
> - * cannot just call hangup() because that will cause
> - * tty->count and state->count to go out of sync.
> - * So we just call close() the right number of times.
> - */
> - if (cons_filp) {
> - if (tty->driver->close)
> - for (n = 0; n < closecount; n++)
> - tty->driver->close(tty, cons_filp);
> - } else if (tty->driver->hangup)
> - (tty->driver->hangup)(tty);
> -
> - /* We don't want to have driver/ldisc interactions beyond
> - the ones we did here. The driver layer expects no
> - calls after ->hangup() from the ldisc side. However we
> - can't yet guarantee all that */
> -
> - set_bit(TTY_HUPPED, &tty->flags);
> - if (ld) {
> - tty_ldisc_enable(tty);
> - tty_ldisc_deref(ld);
> - }
> - unlock_kernel();
> - if (f)
> - fput(f);
> -}
> -
> -void tty_hangup(struct tty_struct * tty)
> -{
> -#ifdef TTY_DEBUG_HANGUP
> - char buf[64];
> -
> - printk(KERN_DEBUG "%s hangup...\n", tty_name(tty, buf));
> -#endif
> - schedule_work(&tty->hangup_work);
> -}
> -
> -EXPORT_SYMBOL(tty_hangup);
> -
> -void tty_vhangup(struct tty_struct * tty)
> -{
> -#ifdef TTY_DEBUG_HANGUP
> - char buf[64];
> -
> - printk(KERN_DEBUG "%s vhangup...\n", tty_name(tty, buf));
> -#endif
> - do_tty_hangup((void *) tty);
> -}
> -EXPORT_SYMBOL(tty_vhangup);
> -
> -int tty_hung_up_p(struct file * filp)
> -{
> - return (filp->f_op == &hung_up_tty_fops);
> -}
> -
> -EXPORT_SYMBOL(tty_hung_up_p);
> -
> -/*
> - * This function is typically called only by the session leader, when
> - * it wants to disassociate itself from its controlling tty.
> - *
> - * It performs the following functions:
> - * (1) Sends a SIGHUP and SIGCONT to the foreground process group
> - * (2) Clears the tty from being controlling the session
> - * (3) Clears the controlling tty for all processes in the
> - * session group.
> - *
> - * The argument on_exit is set to 1 if called when a process is
> - * exiting; it is 0 if called by the ioctl TIOCNOTTY.
> - */
> -void disassociate_ctty(int on_exit)
> -{
> - struct tty_struct *tty;
> - struct task_struct *p;
> - int tty_pgrp = -1;
> -
> - lock_kernel();
> -
> - down(&tty_sem);
> - tty = current->signal->tty;
> - if (tty) {
> - tty_pgrp = tty->pgrp;
> - up(&tty_sem);
> - if (on_exit && tty->driver->type != TTY_DRIVER_TYPE_PTY)
> - tty_vhangup(tty);
> - } else {
> - if (current->signal->tty_old_pgrp) {
> - kill_pg(current->signal->tty_old_pgrp, SIGHUP, on_exit);
> - kill_pg(current->signal->tty_old_pgrp, SIGCONT,
> on_exit);
> - }
> - up(&tty_sem);
> - unlock_kernel();
> - return;
> - }
> - if (tty_pgrp > 0) {
> - kill_pg(tty_pgrp, SIGHUP, on_exit);
> - if (!on_exit)
> - kill_pg(tty_pgrp, SIGCONT, on_exit);
> - }
> -
> - /* Must lock changes to tty_old_pgrp */
> - down(&tty_sem);
> - current->signal->tty_old_pgrp = 0;
> - tty->session = 0;
> - tty->pgrp = -1;
> -
> - /* Now clear signal->tty under the lock */
> - read_lock(&tasklist_lock);
> - do_each_task_pid(current->signal->session, PIDTYPE_SID, p) {
> - p->signal->tty = NULL;
> - } while_each_task_pid(current->signal->session, PIDTYPE_SID, p);
> - read_unlock(&tasklist_lock);
> - up(&tty_sem);
> - unlock_kernel();
> -}
> -
> -void stop_tty(struct tty_struct *tty)
> -{
> - if (tty->stopped)
> - return;
> - tty->stopped = 1;
> - if (tty->link && tty->link->packet) {
> - tty->ctrl_status &= ~TIOCPKT_START;
> - tty->ctrl_status |= TIOCPKT_STOP;
> - wake_up_interruptible(&tty->link->read_wait);
> - }
> - if (tty->driver->stop)
> - (tty->driver->stop)(tty);
> -}
> -
> -EXPORT_SYMBOL(stop_tty);
> -
> -void start_tty(struct tty_struct *tty)
> -{
> - if (!tty->stopped || tty->flow_stopped)
> - return;
> - tty->stopped = 0;
> - if (tty->link && tty->link->packet) {
> - tty->ctrl_status &= ~TIOCPKT_STOP;
> - tty->ctrl_status |= TIOCPKT_START;
> - wake_up_interruptible(&tty->link->read_wait);
> - }
> - if (tty->driver->start)
> - (tty->driver->start)(tty);
> -
> - /* If we have a running line discipline it may need kicking */
> - tty_wakeup(tty);
> - wake_up_interruptible(&tty->write_wait);
> -}
> -
> -EXPORT_SYMBOL(start_tty);
> -
> -static ssize_t tty_read(struct file * file, char __user * buf, size_t count,
> - loff_t *ppos)
> -{
> - int i;
> - struct tty_struct * tty;
> - struct inode *inode;
> - struct tty_ldisc *ld;
> -
> - tty = (struct tty_struct *)file->private_data;
> - inode = file->f_dentry->d_inode;
> - if (tty_paranoia_check(tty, inode, "tty_read"))
> - return -EIO;
> - if (!tty || (test_bit(TTY_IO_ERROR, &tty->flags)))
> - return -EIO;
> -
> - /* We want to wait for the line discipline to sort out in this
> - situation */
> - ld = tty_ldisc_ref_wait(tty);
> - lock_kernel();
> - if (ld->read)
> - i = (ld->read)(tty,file,buf,count);
> - else
> - i = -EIO;
> - tty_ldisc_deref(ld);
> - unlock_kernel();
> - if (i > 0)
> - inode->i_atime = current_fs_time(inode->i_sb);
> - return i;
> -}
> -
> -/*
> - * Split writes up in sane blocksizes to avoid
> - * denial-of-service type attacks
> - */
> -static inline ssize_t do_tty_write(
> - ssize_t (*write)(struct tty_struct *, struct file *, const unsigned
> char *, size_t),
> - struct tty_struct *tty,
> - struct file *file,
> - const char __user *buf,
> - size_t count)
> -{
> - ssize_t ret = 0, written = 0;
> - unsigned int chunk;
> -
> - if (down_interruptible(&tty->atomic_write)) {
> - return -ERESTARTSYS;
> - }
> -
> - /*
> - * We chunk up writes into a temporary buffer. This
> - * simplifies low-level drivers immensely, since they
> - * don't have locking issues and user mode accesses.
> - *
> - * But if TTY_NO_WRITE_SPLIT is set, we should use a
> - * big chunk-size..
> - *
> - * The default chunk-size is 2kB, because the NTTY
> - * layer has problems with bigger chunks. It will
> - * claim to be able to handle more characters than
> - * it actually does.
> - */
> - chunk = 2048;
> - if (test_bit(TTY_NO_WRITE_SPLIT, &tty->flags))
> - chunk = 65536;
> - if (count < chunk)
> - chunk = count;
> -
> - /* write_buf/write_cnt is protected by the atomic_write semaphore */
> - if (tty->write_cnt < chunk) {
> - unsigned char *buf;
> -
> - if (chunk < 1024)
> - chunk = 1024;
> -
> - buf = kmalloc(chunk, GFP_KERNEL);
> - if (!buf) {
> - up(&tty->atomic_write);
> - return -ENOMEM;
> - }
> - kfree(tty->write_buf);
> - tty->write_cnt = chunk;
> - tty->write_buf = buf;
> - }
> -
> - /* Do the write .. */
> - for (;;) {
> - size_t size = count;
> - if (size > chunk)
> - size = chunk;
> - ret = -EFAULT;
> - if (copy_from_user(tty->write_buf, buf, size))
> - break;
> - lock_kernel();
> - ret = write(tty, file, tty->write_buf, size);
> - unlock_kernel();
> - if (ret <= 0)
> - break;
> - written += ret;
> - buf += ret;
> - count -= ret;
> - if (!count)
> - break;
> - ret = -ERESTARTSYS;
> - if (signal_pending(current))
> - break;
> - cond_resched();
> - }
> - if (written) {
> - struct inode *inode = file->f_dentry->d_inode;
> - inode->i_mtime = current_fs_time(inode->i_sb);
> - ret = written;
> - }
> - up(&tty->atomic_write);
> - return ret;
> -}
> -
> -
> -static ssize_t tty_write(struct file * file, const char __user * buf, size_t
> count,
> - loff_t *ppos)
> -{
> - struct tty_struct * tty;
> - struct inode *inode = file->f_dentry->d_inode;
> - ssize_t ret;
> - struct tty_ldisc *ld;
> -
> - tty = (struct tty_struct *)file->private_data;
> - if (tty_paranoia_check(tty, inode, "tty_write"))
> - return -EIO;
> - if (!tty || !tty->driver->write || (test_bit(TTY_IO_ERROR,
> &tty->flags)))
> - return -EIO;
> -
> - ld = tty_ldisc_ref_wait(tty);
> - if (!ld->write)
> - ret = -EIO;
> - else
> - ret = do_tty_write(ld->write, tty, file, buf, count);
> - tty_ldisc_deref(ld);
> - return ret;
> -}
> -
> -ssize_t redirected_tty_write(struct file * file, const char __user * buf,
> size_t count,
> - loff_t *ppos)
> -{
> - struct file *p = NULL;
> -
> - spin_lock(&redirect_lock);
> - if (redirect) {
> - get_file(redirect);
> - p = redirect;
> - }
> - spin_unlock(&redirect_lock);
> -
> - if (p) {
> - ssize_t res;
> - res = vfs_write(p, buf, count, &p->f_pos);
> - fput(p);
> - return res;
> - }
> -
> - return tty_write(file, buf, count, ppos);
> -}
> -
> -static char ptychar[] = "pqrstuvwxyzabcde";
> -
> -static inline void pty_line_name(struct tty_driver *driver, int index, char
> *p)
> -{
> - int i = index + driver->name_base;
> - /* ->name is initialized to "ttyp", but "tty" is expected */
> - sprintf(p, "%s%c%x",
> - driver->subtype == PTY_TYPE_SLAVE ? "tty" :
> driver->name,
> - ptychar[i >> 4 & 0xf], i & 0xf);
> -}
> -
> -static inline void tty_line_name(struct tty_driver *driver, int index, char
> *p)
> -{
> - sprintf(p, "%s%d", driver->name, index + driver->name_base);
> -}
> -
> -/*
> - * WSH 06/09/97: Rewritten to remove races and properly clean up after a
> - * failed open. The new code protects the open with a semaphore, so it's
> - * really quite straightforward. The semaphore locking can probably be
> - * relaxed for the (most common) case of reopening a tty.
> - */
> -static int init_dev(struct tty_driver *driver, int idx,
> - struct tty_struct **ret_tty)
> -{
> - struct tty_struct *tty, *o_tty;
> - struct termios *tp, **tp_loc, *o_tp, **o_tp_loc;
> - struct termios *ltp, **ltp_loc, *o_ltp, **o_ltp_loc;
> - int retval=0;
> -
> - /* check whether we're reopening an existing tty */
> - if (driver->flags & TTY_DRIVER_DEVPTS_MEM) {
> - tty = devpts_get_tty(idx);
> - if (tty && driver->subtype == PTY_TYPE_MASTER)
> - tty = tty->link;
> - } else {
> - tty = driver->ttys[idx];
> - }
> - if (tty) goto fast_track;
> -
> - /*
> - * First time open is complex, especially for PTY devices.
> - * This code guarantees that either everything succeeds and the
> - * TTY is ready for operation, or else the table slots are vacated
> - * and the allocated memory released. (Except that the termios
> - * and locked termios may be retained.)
> - */
> -
> - if (!try_module_get(driver->owner)) {
> - retval = -ENODEV;
> - goto end_init;
> - }
> -
> - o_tty = NULL;
> - tp = o_tp = NULL;
> - ltp = o_ltp = NULL;
> -
> - tty = alloc_tty_struct();
> - if(!tty)
> - goto fail_no_mem;
> - initialize_tty_struct(tty);
> - tty->driver = driver;
> - tty->index = idx;
> - tty_line_name(driver, idx, tty->name);
> -
> - if (driver->flags & TTY_DRIVER_DEVPTS_MEM) {
> - tp_loc = &tty->termios;
> - ltp_loc = &tty->termios_locked;
> - } else {
> - tp_loc = &driver->termios[idx];
> - ltp_loc = &driver->termios_locked[idx];
> - }
> -
> - if (!*tp_loc) {
> - tp = (struct termios *) kmalloc(sizeof(struct termios),
> - GFP_KERNEL);
> - if (!tp)
> - goto free_mem_out;
> - *tp = driver->init_termios;
> - }
> -
> - if (!*ltp_loc) {
> - ltp = (struct termios *) kmalloc(sizeof(struct termios),
> - GFP_KERNEL);
> - if (!ltp)
> - goto free_mem_out;
> - memset(ltp, 0, sizeof(struct termios));
> - }
> -
> - if (driver->type == TTY_DRIVER_TYPE_PTY) {
> - o_tty = alloc_tty_struct();
> - if (!o_tty)
> - goto free_mem_out;
> - initialize_tty_struct(o_tty);
> - o_tty->driver = driver->other;
> - o_tty->index = idx;
> - tty_line_name(driver->other, idx, o_tty->name);
> -
> - if (driver->flags & TTY_DRIVER_DEVPTS_MEM) {
> - o_tp_loc = &o_tty->termios;
> - o_ltp_loc = &o_tty->termios_locked;
> - } else {
> - o_tp_loc = &driver->other->termios[idx];
> - o_ltp_loc = &driver->other->termios_locked[idx];
> - }
> -
> - if (!*o_tp_loc) {
> - o_tp = (struct termios *)
> - kmalloc(sizeof(struct termios), GFP_KERNEL);
> - if (!o_tp)
> - goto free_mem_out;
> - *o_tp = driver->other->init_termios;
> - }
> -
> - if (!*o_ltp_loc) {
> - o_ltp = (struct termios *)
> - kmalloc(sizeof(struct termios), GFP_KERNEL);
> - if (!o_ltp)
> - goto free_mem_out;
> - memset(o_ltp, 0, sizeof(struct termios));
> - }
> -
> - /*
> - * Everything allocated ... set up the o_tty structure.
> - */
> - if (!(driver->other->flags & TTY_DRIVER_DEVPTS_MEM)) {
> - driver->other->ttys[idx] = o_tty;
> - }
> - if (!*o_tp_loc)
> - *o_tp_loc = o_tp;
> - if (!*o_ltp_loc)
> - *o_ltp_loc = o_ltp;
> - o_tty->termios = *o_tp_loc;
> - o_tty->termios_locked = *o_ltp_loc;
> - driver->other->refcount++;
> - if (driver->subtype == PTY_TYPE_MASTER)
> - o_tty->count++;
> -
> - /* Establish the links in both directions */
> - tty->link = o_tty;
> - o_tty->link = tty;
> - }
> -
> - /*
> - * All structures have been allocated, so now we install them.
> - * Failures after this point use release_mem to clean up, so
> - * there's no need to null out the local pointers.
> - */
> - if (!(driver->flags & TTY_DRIVER_DEVPTS_MEM)) {
> - driver->ttys[idx] = tty;
> - }
> -
> - if (!*tp_loc)
> - *tp_loc = tp;
> - if (!*ltp_loc)
> - *ltp_loc = ltp;
> - tty->termios = *tp_loc;
> - tty->termios_locked = *ltp_loc;
> - driver->refcount++;
> - tty->count++;
> -
> - /*
> - * Structures all installed ... call the ldisc open routines.
> - * If we fail here just call release_mem to clean up. No need
> - * to decrement the use counts, as release_mem doesn't care.
> - */
> -
> - if (tty->ldisc.open) {
> - retval = (tty->ldisc.open)(tty);
> - if (retval)
> - goto release_mem_out;
> - }
> - if (o_tty && o_tty->ldisc.open) {
> - retval = (o_tty->ldisc.open)(o_tty);
> - if (retval) {
> - if (tty->ldisc.close)
> - (tty->ldisc.close)(tty);
> - goto release_mem_out;
> - }
> - tty_ldisc_enable(o_tty);
> - }
> - tty_ldisc_enable(tty);
> - goto success;
> -
> - /*
> - * This fast open can be used if the tty is already open.
> - * No memory is allocated, and the only failures are from
> - * attempting to open a closing tty or attempting multiple
> - * opens on a pty master.
> - */
> -fast_track:
> - if (test_bit(TTY_CLOSING, &tty->flags)) {
> - retval = -EIO;
> - goto end_init;
> - }
> - if (driver->type == TTY_DRIVER_TYPE_PTY &&
> - driver->subtype == PTY_TYPE_MASTER) {
> - /*
> - * special case for PTY masters: only one open permitted,
> - * and the slave side open count is incremented as well.
> - */
> - if (tty->count) {
> - retval = -EIO;
> - goto end_init;
> - }
> - tty->link->count++;
> - }
> - tty->count++;
> - tty->driver = driver; /* N.B. why do this every time?? */
> -
> - /* FIXME */
> - if(!test_bit(TTY_LDISC, &tty->flags))
> - printk(KERN_ERR "init_dev but no ldisc\n");
> -success:
> - *ret_tty = tty;
> -
> - /* All paths come through here to release the semaphore */
> -end_init:
> - return retval;
> -
> - /* Release locally allocated memory ... nothing placed in slots */
> -free_mem_out:
> - kfree(o_tp);
> - if (o_tty)
> - free_tty_struct(o_tty);
> - kfree(ltp);
> - kfree(tp);
> - free_tty_struct(tty);
> -
> -fail_no_mem:
> - module_put(driver->owner);
> - retval = -ENOMEM;
> - goto end_init;
> -
> - /* call the tty release_mem routine to clean out this slot */
> -release_mem_out:
> - printk(KERN_INFO "init_dev: ldisc open failed, "
> - "clearing slot %d\n", idx);
> - release_mem(tty, idx);
> - goto end_init;
> -}
> -
> -/*
> - * Releases memory associated with a tty structure, and clears out the
> - * driver table slots.
> - */
> -static void release_mem(struct tty_struct *tty, int idx)
> -{
> - struct tty_struct *o_tty;
> - struct termios *tp;
> - int devpts = tty->driver->flags & TTY_DRIVER_DEVPTS_MEM;
> -
> - if ((o_tty = tty->link) != NULL) {
> - if (!devpts)
> - o_tty->driver->ttys[idx] = NULL;
> - if (o_tty->driver->flags & TTY_DRIVER_RESET_TERMIOS) {
> - tp = o_tty->termios;
> - if (!devpts)
> - o_tty->driver->termios[idx] = NULL;
> - kfree(tp);
> -
> - tp = o_tty->termios_locked;
> - if (!devpts)
> - o_tty->driver->termios_locked[idx] = NULL;
> - kfree(tp);
> - }
> - o_tty->magic = 0;
> - o_tty->driver->refcount--;
> - file_list_lock();
> - list_del_init(&o_tty->tty_files);
> - file_list_unlock();
> - free_tty_struct(o_tty);
> - }
> -
> - if (!devpts)
> - tty->driver->ttys[idx] = NULL;
> - if (tty->driver->flags & TTY_DRIVER_RESET_TERMIOS) {
> - tp = tty->termios;
> - if (!devpts)
> - tty->driver->termios[idx] = NULL;
> - kfree(tp);
> -
> - tp = tty->termios_locked;
> - if (!devpts)
> - tty->driver->termios_locked[idx] = NULL;
> - kfree(tp);
> - }
> -
> - tty->magic = 0;
> - tty->driver->refcount--;
> - file_list_lock();
> - list_del_init(&tty->tty_files);
> - file_list_unlock();
> - module_put(tty->driver->owner);
> - free_tty_struct(tty);
> -}
> -
> -/*
> - * Even releasing the tty structures is a tricky business.. We have
> - * to be very careful that the structures are all released at the
> - * same time, as interrupts might otherwise get the wrong pointers.
> - *
> - * WSH 09/09/97: rewritten to avoid some nasty race conditions that could
> - * lead to double frees or releasing memory still in use.
> - */
> -static void release_dev(struct file * filp)
> -{
> - struct tty_struct *tty, *o_tty;
> - int pty_master, tty_closing, o_tty_closing, do_sleep;
> - int devpts_master, devpts;
> - int idx;
> - char buf[64];
> - unsigned long flags;
> -
> - tty = (struct tty_struct *)filp->private_data;
> - if (tty_paranoia_check(tty, filp->f_dentry->d_inode, "release_dev"))
> - return;
> -
> - check_tty_count(tty, "release_dev");
> -
> - tty_fasync(-1, filp, 0);
> -
> - idx = tty->index;
> - pty_master = (tty->driver->type == TTY_DRIVER_TYPE_PTY &&
> - tty->driver->subtype == PTY_TYPE_MASTER);
> - devpts = (tty->driver->flags & TTY_DRIVER_DEVPTS_MEM) != 0;
> - devpts_master = pty_master && devpts;
> - o_tty = tty->link;
> -
> -#ifdef TTY_PARANOIA_CHECK
> - if (idx < 0 || idx >= tty->driver->num) {
> - printk(KERN_DEBUG "release_dev: bad idx when trying to "
> - "free (%s)\n", tty->name);
> - return;
> - }
> - if (!(tty->driver->flags & TTY_DRIVER_DEVPTS_MEM)) {
> - if (tty != tty->driver->ttys[idx]) {
> - printk(KERN_DEBUG "release_dev: driver.table[%d] not
> tty "
> - "for (%s)\n", idx, tty->name);
> - return;
> - }
> - if (tty->termios != tty->driver->termios[idx]) {
> - printk(KERN_DEBUG "release_dev: driver.termios[%d] not
> termios "
> - "for (%s)\n",
> - idx, tty->name);
> - return;
> - }
> - if (tty->termios_locked != tty->driver->termios_locked[idx]) {
> - printk(KERN_DEBUG "release_dev:
> driver.termios_locked[%d] not "
> - "termios_locked for (%s)\n",
> - idx, tty->name);
> - return;
> - }
> - }
> -#endif
> -
> -#ifdef TTY_DEBUG_HANGUP
> - printk(KERN_DEBUG "release_dev of %s (tty count=%d)...",
> - tty_name(tty, buf), tty->count);
> -#endif
> -
> -#ifdef TTY_PARANOIA_CHECK
> - if (tty->driver->other &&
> - !(tty->driver->flags & TTY_DRIVER_DEVPTS_MEM)) {
> - if (o_tty != tty->driver->other->ttys[idx]) {
> - printk(KERN_DEBUG "release_dev: other->table[%d] "
> - "not o_tty for (%s)\n",
> - idx, tty->name);
> - return;
> - }
> - if (o_tty->termios != tty->driver->other->termios[idx]) {
> - printk(KERN_DEBUG "release_dev: other->termios[%d] "
> - "not o_termios for (%s)\n",
> - idx, tty->name);
> - return;
> - }
> - if (o_tty->termios_locked !=
> - tty->driver->other->termios_locked[idx]) {
> - printk(KERN_DEBUG "release_dev: other->termios_locked["
> - "%d] not o_termios_locked for (%s)\n",
> - idx, tty->name);
> - return;
> - }
> - if (o_tty->link != tty) {
> - printk(KERN_DEBUG "release_dev: bad pty pointers\n");
> - return;
> - }
> - }
> -#endif
> - if (tty->driver->close)
> - tty->driver->close(tty, filp);
> -
> - /*
> - * Sanity check: if tty->count is going to zero, there shouldn't be
> - * any waiters on tty->read_wait or tty->write_wait. We test the
> - * wait queues and kick everyone out _before_ actually starting to
> - * close. This ensures that we won't block while releasing the tty
> - * structure.
> - *
> - * The test for the o_tty closing is necessary, since the master and
> - * slave sides may close in any order. If the slave side closes out
> - * first, its count will be one, since the master side holds an open.
> - * Thus this test wouldn't be triggered at the time the slave closes,
> - * so we do it now.
> - *
> - * Note that it's possible for the tty to be opened again while we're
> - * flushing out waiters. By recalculating the closing flags before
> - * each iteration we avoid any problems.
> - */
> - while (1) {
> - /* Guard against races with tty->count changes elsewhere and
> - opens on /dev/tty */
> -
> - down(&tty_sem);
> - tty_closing = tty->count <= 1;
> - o_tty_closing = o_tty &&
> - (o_tty->count <= (pty_master ? 1 : 0));
> - do_sleep = 0;
> -
> - if (tty_closing) {
> - if (waitqueue_active(&tty->read_wait)) {
> - wake_up(&tty->read_wait);
> - do_sleep++;
> - }
> - if (waitqueue_active(&tty->write_wait)) {
> - wake_up(&tty->write_wait);
> - do_sleep++;
> - }
> - }
> - if (o_tty_closing) {
> - if (waitqueue_active(&o_tty->read_wait)) {
> - wake_up(&o_tty->read_wait);
> - do_sleep++;
> - }
> - if (waitqueue_active(&o_tty->write_wait)) {
> - wake_up(&o_tty->write_wait);
> - do_sleep++;
> - }
> - }
> - if (!do_sleep)
> - break;
> -
> - printk(KERN_WARNING "release_dev: %s: read/write wait queue "
> - "active!\n", tty_name(tty, buf));
> - up(&tty_sem);
> - schedule();
> - }
> -
> - /*
> - * The closing flags are now consistent with the open counts on
> - * both sides, and we've completed the last operation that could
> - * block, so it's safe to proceed with closing.
> - */
> - if (pty_master) {
> - if (--o_tty->count < 0) {
> - printk(KERN_WARNING "release_dev: bad pty slave count "
> - "(%d) for %s\n",
> - o_tty->count, tty_name(o_tty, buf));
> - o_tty->count = 0;
> - }
> - }
> - if (--tty->count < 0) {
> - printk(KERN_WARNING "release_dev: bad tty->count (%d) for %s\n",
> - tty->count, tty_name(tty, buf));
> - tty->count = 0;
> - }
> -
> - /*
> - * We've decremented tty->count, so we need to remove this file
> - * descriptor off the tty->tty_files list; this serves two
> - * purposes:
> - * - check_tty_count sees the correct number of file descriptors
> - * associated with this tty.
> - * - do_tty_hangup no longer sees this file descriptor as
> - * something that needs to be handled for hangups.
> - */
> - file_kill(filp);
> - filp->private_data = NULL;
> -
> - /*
> - * Perform some housekeeping before deciding whether to return.
> - *
> - * Set the TTY_CLOSING flag if this was the last open. In the
> - * case of a pty we may have to wait around for the other side
> - * to close, and TTY_CLOSING makes sure we can't be reopened.
> - */
> - if(tty_closing)
> - set_bit(TTY_CLOSING, &tty->flags);
> - if(o_tty_closing)
> - set_bit(TTY_CLOSING, &o_tty->flags);
> -
> - /*
> - * If _either_ side is closing, make sure there aren't any
> - * processes that still think tty or o_tty is their controlling
> - * tty.
> - */
> - if (tty_closing || o_tty_closing) {
> - struct task_struct *p;
> -
> - read_lock(&tasklist_lock);
> - do_each_task_pid(tty->session, PIDTYPE_SID, p) {
> - p->signal->tty = NULL;
> - } while_each_task_pid(tty->session, PIDTYPE_SID, p);
> - if (o_tty)
> - do_each_task_pid(o_tty->session, PIDTYPE_SID, p) {
> - p->signal->tty = NULL;
> - } while_each_task_pid(o_tty->session, PIDTYPE_SID, p);
> - read_unlock(&tasklist_lock);
> - }
> -
> - up(&tty_sem);
> -
> - /* check whether both sides are closing ... */
> - if (!tty_closing || (o_tty && !o_tty_closing))
> - return;
> -
> -#ifdef TTY_DEBUG_HANGUP
> - printk(KERN_DEBUG "freeing tty structure...");
> -#endif
> - /*
> - * Prevent flush_to_ldisc() from rescheduling the work for later. Then
> - * kill any delayed work. As this is the final close it does not
> - * race with the set_ldisc code path.
> - */
> - clear_bit(TTY_LDISC, &tty->flags);
> - clear_bit(TTY_DONT_FLIP, &tty->flags);
> - cancel_delayed_work(&tty->buf.work);
> -
> - /*
> - * Wait for ->hangup_work and ->buf.work handlers to terminate
> - */
> -
> - flush_scheduled_work();
> -
> - /*
> - * Wait for any short term users (we know they are just driver
> - * side waiters as the file is closing so user count on the file
> - * side is zero.
> - */
> - spin_lock_irqsave(&tty_ldisc_lock, flags);
> - while(tty->ldisc.refcount)
> - {
> - spin_unlock_irqrestore(&tty_ldisc_lock, flags);
> - wait_event(tty_ldisc_wait, tty->ldisc.refcount == 0);
> - spin_lock_irqsave(&tty_ldisc_lock, flags);
> - }
> - spin_unlock_irqrestore(&tty_ldisc_lock, flags);
> - /*
> - * Shutdown the current line discipline, and reset it to N_TTY.
> - * N.B. why reset ldisc when we're releasing the memory??
> - *
> - * FIXME: this MUST get fixed for the new reflocking
> - */
> - if (tty->ldisc.close)
> - (tty->ldisc.close)(tty);
> - tty_ldisc_put(tty->ldisc.num);
> -
> - /*
> - * Switch the line discipline back
> - */
> - tty_ldisc_assign(tty, tty_ldisc_get(N_TTY));
> - tty_set_termios_ldisc(tty,N_TTY);
> - if (o_tty) {
> - /* FIXME: could o_tty be in setldisc here ? */
> - clear_bit(TTY_LDISC, &o_tty->flags);
> - if (o_tty->ldisc.close)
> - (o_tty->ldisc.close)(o_tty);
> - tty_ldisc_put(o_tty->ldisc.num);
> - tty_ldisc_assign(o_tty, tty_ldisc_get(N_TTY));
> - tty_set_termios_ldisc(o_tty,N_TTY);
> - }
> - /*
> - * The release_mem function takes care of the details of clearing
> - * the slots and preserving the termios structure.
> - */
> - release_mem(tty, idx);
> -
> -#ifdef CONFIG_UNIX98_PTYS
> - /* Make this pty number available for reallocation */
> - if (devpts) {
> - down(&allocated_ptys_lock);
> - idr_remove(&allocated_ptys, idx);
> - up(&allocated_ptys_lock);
> - }
> -#endif
> -
> -}
> -
> -/*
> - * tty_open and tty_release keep up the tty count that contains the
> - * number of opens done on a tty. We cannot use the inode-count, as
> - * different inodes might point to the same tty.
> - *
> - * Open-counting is needed for pty masters, as well as for keeping
> - * track of serial lines: DTR is dropped when the last close happens.
> - * (This is not done solely through tty->count, now. - Ted 1/27/92)
> - *
> - * The termios state of a pty is reset on first open so that
> - * settings don't persist across reuse.
> - */
> -static int tty_open(struct inode * inode, struct file * filp)
> -{
> - struct tty_struct *tty;
> - int noctty, retval;
> - struct tty_driver *driver;
> - int index;
> - dev_t device = inode->i_rdev;
> - unsigned short saved_flags = filp->f_flags;
> -
> - nonseekable_open(inode, filp);
> -
> -retry_open:
> - noctty = filp->f_flags & O_NOCTTY;
> - index = -1;
> - retval = 0;
> -
> - down(&tty_sem);
> -
> - if (device == MKDEV(TTYAUX_MAJOR,0)) {
> - if (!current->signal->tty) {
> - up(&tty_sem);
> - return -ENXIO;
> - }
> - driver = current->signal->tty->driver;
> - index = current->signal->tty->index;
> - filp->f_flags |= O_NONBLOCK; /* Don't let /dev/tty block */
> - /* noctty = 1; */
> - goto got_driver;
> - }
> -#ifdef CONFIG_VT
> - if (console_use_vt && (device == MKDEV(TTY_MAJOR,0))) {
> - extern struct tty_driver *console_driver;
> - driver = console_driver;
> - index = fg_console;
> - noctty = 1;
> - goto got_driver;
> - }
> -#endif
> - if (device == MKDEV(TTYAUX_MAJOR,1)) {
> - driver = console_device(&index);
> - if (driver) {
> - /* Don't let /dev/console block */
> - filp->f_flags |= O_NONBLOCK;
> - noctty = 1;
> - goto got_driver;
> - }
> - up(&tty_sem);
> - return -ENODEV;
> - }
> -
> - driver = get_tty_driver(device, &index);
> - if (!driver) {
> - up(&tty_sem);
> - return -ENODEV;
> - }
> -got_driver:
> - retval = init_dev(driver, index, &tty);
> - up(&tty_sem);
> - if (retval)
> - return retval;
> -
> - filp->private_data = tty;
> - file_move(filp, &tty->tty_files);
> - check_tty_count(tty, "tty_open");
> - if (tty->driver->type == TTY_DRIVER_TYPE_PTY &&
> - tty->driver->subtype == PTY_TYPE_MASTER)
> - noctty = 1;
> -#ifdef TTY_DEBUG_HANGUP
> - printk(KERN_DEBUG "opening %s...", tty->name);
> -#endif
> - if (!retval) {
> - if (tty->driver->open)
> - retval = tty->driver->open(tty, filp);
> - else
> - retval = -ENODEV;
> - }
> - filp->f_flags = saved_flags;
> -
> - if (!retval && test_bit(TTY_EXCLUSIVE, &tty->flags) &&
> !capable(CAP_SYS_ADMIN))
> - retval = -EBUSY;
> -
> - if (retval) {
> -#ifdef TTY_DEBUG_HANGUP
> - printk(KERN_DEBUG "error %d in opening %s...", retval,
> - tty->name);
> -#endif
> - release_dev(filp);
> - if (retval != -ERESTARTSYS)
> - return retval;
> - if (signal_pending(current))
> - return retval;
> - schedule();
> - /*
> - * Need to reset f_op in case a hangup happened.
> - */
> - if (filp->f_op == &hung_up_tty_fops)
> - filp->f_op = &tty_fops;
> - goto retry_open;
> - }
> - if (!noctty &&
> - current->signal->leader &&
> - !current->signal->tty &&
> - tty->session == 0) {
> - task_lock(current);
> - current->signal->tty = tty;
> - task_unlock(current);
> - current->signal->tty_old_pgrp = 0;
> - tty->session = current->signal->session;
> - tty->pgrp = process_group(current);
> - }
> - return 0;
> -}
> -
> -#ifdef CONFIG_UNIX98_PTYS
> -static int ptmx_open(struct inode * inode, struct file * filp)
> -{
> - struct tty_struct *tty;
> - int retval;
> - int index;
> - int idr_ret;
> -
> - nonseekable_open(inode, filp);
> -
> - /* find a device that is not in use. */
> - down(&allocated_ptys_lock);
> - if (!idr_pre_get(&allocated_ptys, GFP_KERNEL)) {
> - up(&allocated_ptys_lock);
> - return -ENOMEM;
> - }
> - idr_ret = idr_get_new(&allocated_ptys, NULL, &index);
> - if (idr_ret < 0) {
> - up(&allocated_ptys_lock);
> - if (idr_ret == -EAGAIN)
> - return -ENOMEM;
> - return -EIO;
> - }
> - if (index >= pty_limit) {
> - idr_remove(&allocated_ptys, index);
> - up(&allocated_ptys_lock);
> - return -EIO;
> - }
> - up(&allocated_ptys_lock);
> -
> - down(&tty_sem);
> - retval = init_dev(ptm_driver, index, &tty);
> - up(&tty_sem);
> -
> - if (retval)
> - goto out;
> -
> - set_bit(TTY_PTY_LOCK, &tty->flags); /* LOCK THE SLAVE */
> - filp->private_data = tty;
> - file_move(filp, &tty->tty_files);
> -
> - retval = -ENOMEM;
> - if (devpts_pty_new(tty->link))
> - goto out1;
> -
> - check_tty_count(tty, "tty_open");
> - retval = ptm_driver->open(tty, filp);
> - if (!retval)
> - return 0;
> -out1:
> - release_dev(filp);
> -out:
> - down(&allocated_ptys_lock);
> - idr_remove(&allocated_ptys, index);
> - up(&allocated_ptys_lock);
> - return retval;
> -}
> -#endif
> -
> -static int tty_release(struct inode * inode, struct file * filp)
> -{
> - lock_kernel();
> - release_dev(filp);
> - unlock_kernel();
> - return 0;
> -}
> -
> -/* No kernel lock held - fine */
> -static unsigned int tty_poll(struct file * filp, poll_table * wait)
> -{
> - struct tty_struct * tty;
> - struct tty_ldisc *ld;
> - int ret = 0;
> -
> - tty = (struct tty_struct *)filp->private_data;
> - if (tty_paranoia_check(tty, filp->f_dentry->d_inode, "tty_poll"))
> - return 0;
> -
> - ld = tty_ldisc_ref_wait(tty);
> - if (ld->poll)
> - ret = (ld->poll)(tty, filp, wait);
> - tty_ldisc_deref(ld);
> - return ret;
> -}
> -
> -static int tty_fasync(int fd, struct file * filp, int on)
> -{
> - struct tty_struct * tty;
> - int retval;
> -
> - tty = (struct tty_struct *)filp->private_data;
> - if (tty_paranoia_check(tty, filp->f_dentry->d_inode, "tty_fasync"))
> - return 0;
> -
> - retval = fasync_helper(fd, filp, on, &tty->fasync);
> - if (retval <= 0)
> - return retval;
> -
> - if (on) {
> - if (!waitqueue_active(&tty->read_wait))
> - tty->minimum_to_wake = 1;
> - retval = f_setown(filp, (-tty->pgrp) ? : current->pid, 0);
> - if (retval)
> - return retval;
> - } else {
> - if (!tty->fasync && !waitqueue_active(&tty->read_wait))
> - tty->minimum_to_wake = N_TTY_BUF_SIZE;
> - }
> - return 0;
> -}
> -
> -static int tiocsti(struct tty_struct *tty, char __user *p)
> -{
> - char ch, mbz = 0;
> - struct tty_ldisc *ld;
> -
> - if ((current->signal->tty != tty) && !capable(CAP_SYS_ADMIN))
> - return -EPERM;
> - if (get_user(ch, p))
> - return -EFAULT;
> - ld = tty_ldisc_ref_wait(tty);
> - ld->receive_buf(tty, &ch, &mbz, 1);
> - tty_ldisc_deref(ld);
> - return 0;
> -}
> -
> -static int tiocgwinsz(struct tty_struct *tty, struct winsize __user * arg)
> -{
> - if (copy_to_user(arg, &tty->winsize, sizeof(*arg)))
> - return -EFAULT;
> - return 0;
> -}
> -
> -static int tiocswinsz(struct tty_struct *tty, struct tty_struct *real_tty,
> - struct winsize __user * arg)
> -{
> - struct winsize tmp_ws;
> -
> - if (copy_from_user(&tmp_ws, arg, sizeof(*arg)))
> - return -EFAULT;
> - if (!memcmp(&tmp_ws, &tty->winsize, sizeof(*arg)))
> - return 0;
> -#ifdef CONFIG_VT
> - if (tty->driver->type == TTY_DRIVER_TYPE_CONSOLE) {
> - int rc;
> -
> - acquire_console_sem();
> - rc = vc_resize(tty->driver_data, tmp_ws.ws_col, tmp_ws.ws_row);
> - release_console_sem();
> - if (rc)
> - return -ENXIO;
> - }
> -#endif
> - if (tty->pgrp > 0)
> - kill_pg(tty->pgrp, SIGWINCH, 1);
> - if ((real_tty->pgrp != tty->pgrp) && (real_tty->pgrp > 0))
> - kill_pg(real_tty->pgrp, SIGWINCH, 1);
> - tty->winsize = tmp_ws;
> - real_tty->winsize = tmp_ws;
> - return 0;
> -}
> -
> -static int tioccons(struct file *file)
> -{
> - if (!capable(CAP_SYS_ADMIN))
> - return -EPERM;
> - if (file->f_op->write == redirected_tty_write) {
> - struct file *f;
> - spin_lock(&redirect_lock);
> - f = redirect;
> - redirect = NULL;
> - spin_unlock(&redirect_lock);
> - if (f)
> - fput(f);
> - return 0;
> - }
> - spin_lock(&redirect_lock);
> - if (redirect) {
> - spin_unlock(&redirect_lock);
> - return -EBUSY;
> - }
> - get_file(file);
> - redirect = file;
> - spin_unlock(&redirect_lock);
> - return 0;
> -}
> -
> -
> -static int fionbio(struct file *file, int __user *p)
> -{
> - int nonblock;
> -
> - if (get_user(nonblock, p))
> - return -EFAULT;
> -
> - if (nonblock)
> - file->f_flags |= O_NONBLOCK;
> - else
> - file->f_flags &= ~O_NONBLOCK;
> - return 0;
> -}
> -
> -static int tiocsctty(struct tty_struct *tty, int arg)
> -{
> - task_t *p;
> -
> - if (current->signal->leader &&
> - (current->signal->session == tty->session))
> - return 0;
> - /*
> - * The process must be a session leader and
> - * not have a controlling tty already.
> - */
> - if (!current->signal->leader || current->signal->tty)
> - return -EPERM;
> - if (tty->session > 0) {
> - /*
> - * This tty is already the controlling
> - * tty for another session group!
> - */
> - if ((arg == 1) && capable(CAP_SYS_ADMIN)) {
> - /*
> - * Steal it away
> - */
> -
> - read_lock(&tasklist_lock);
> - do_each_task_pid(tty->session, PIDTYPE_SID, p) {
> - p->signal->tty = NULL;
> - } while_each_task_pid(tty->session, PIDTYPE_SID, p);
> - read_unlock(&tasklist_lock);
> - } else
> - return -EPERM;
> - }
> - task_lock(current);
> - current->signal->tty = tty;
> - task_unlock(current);
> - current->signal->tty_old_pgrp = 0;
> - tty->session = current->signal->session;
> - tty->pgrp = process_group(current);
> - return 0;
> -}
> -
> -static int tiocgpgrp(struct tty_struct *tty, struct tty_struct *real_tty,
> pid_t __user *p)
> -{
> - /*
> - * (tty == real_tty) is a cheap way of
> - * testing if the tty is NOT a master pty.
> - */
> - if (tty == real_tty && current->signal->tty != real_tty)
> - return -ENOTTY;
> - return put_user(real_tty->pgrp, p);
> -}
> -
> -static int tiocspgrp(struct tty_struct *tty, struct tty_struct *real_tty,
> pid_t __user *p)
> -{
> - pid_t pgrp;
> - int retval = tty_check_change(real_tty);
> -
> - if (retval == -EIO)
> - return -ENOTTY;
> - if (retval)
> - return retval;
> - if (!current->signal->tty ||
> - (current->signal->tty != real_tty) ||
> - (real_tty->session != current->signal->session))
> - return -ENOTTY;
> - if (get_user(pgrp, p))
> - return -EFAULT;
> - if (pgrp < 0)
> - return -EINVAL;
> - if (session_of_pgrp(pgrp) != current->signal->session)
> - return -EPERM;
> - real_tty->pgrp = pgrp;
> - return 0;
> -}
> -
> -static int tiocgsid(struct tty_struct *tty, struct tty_struct *real_tty,
> pid_t __user *p)
> -{
> - /*
> - * (tty == real_tty) is a cheap way of
> - * testing if the tty is NOT a master pty.
> - */
> - if (tty == real_tty && current->signal->tty != real_tty)
> - return -ENOTTY;
> - if (real_tty->session <= 0)
> - return -ENOTTY;
> - return put_user(real_tty->session, p);
> -}
> -
> -static int tiocsetd(struct tty_struct *tty, int __user *p)
> -{
> - int ldisc;
> -
> - if (get_user(ldisc, p))
> - return -EFAULT;
> - return tty_set_ldisc(tty, ldisc);
> -}
> -
> -static int send_break(struct tty_struct *tty, unsigned int duration)
> -{
> - tty->driver->break_ctl(tty, -1);
> - if (!signal_pending(current)) {
> - msleep_interruptible(duration);
> - }
> - tty->driver->break_ctl(tty, 0);
> - if (signal_pending(current))
> - return -EINTR;
> - return 0;
> -}
> -
> -static int
> -tty_tiocmget(struct tty_struct *tty, struct file *file, int __user *p)
> -{
> - int retval = -EINVAL;
> -
> - if (tty->driver->tiocmget) {
> - retval = tty->driver->tiocmget(tty, file);
> -
> - if (retval >= 0)
> - retval = put_user(retval, p);
> - }
> - return retval;
> -}
> -
> -static int
> -tty_tiocmset(struct tty_struct *tty, struct file *file, unsigned int cmd,
> - unsigned __user *p)
> -{
> - int retval = -EINVAL;
> -
> - if (tty->driver->tiocmset) {
> - unsigned int set, clear, val;
> -
> - retval = get_user(val, p);
> - if (retval)
> - return retval;
> -
> - set = clear = 0;
> - switch (cmd) {
> - case TIOCMBIS:
> - set = val;
> - break;
> - case TIOCMBIC:
> - clear = val;
> - break;
> - case TIOCMSET:
> - set = val;
> - clear = ~val;
> - break;
> - }
> -
> - set &= TIOCM_DTR|TIOCM_RTS|TIOCM_OUT1|TIOCM_OUT2|TIOCM_LOOP;
> - clear &= TIOCM_DTR|TIOCM_RTS|TIOCM_OUT1|TIOCM_OUT2|TIOCM_LOOP;
> -
> - retval = tty->driver->tiocmset(tty, file, set, clear);
> - }
> - return retval;
> -}
> -
> -/*
> - * Split this up, as gcc can choke on it otherwise..
> - */
> -int tty_ioctl(struct inode * inode, struct file * file,
> - unsigned int cmd, unsigned long arg)
> -{
> - struct tty_struct *tty, *real_tty;
> - void __user *p = (void __user *)arg;
> - int retval;
> - struct tty_ldisc *ld;
> -
> - tty = (struct tty_struct *)file->private_data;
> - if (tty_paranoia_check(tty, inode, "tty_ioctl"))
> - return -EINVAL;
> -
> - real_tty = tty;
> - if (tty->driver->type == TTY_DRIVER_TYPE_PTY &&
> - tty->driver->subtype == PTY_TYPE_MASTER)
> - real_tty = tty->link;
> -
> - /*
> - * Break handling by driver
> - */
> - if (!tty->driver->break_ctl) {
> - switch(cmd) {
> - case TIOCSBRK:
> - case TIOCCBRK:
> - if (tty->driver->ioctl)
> - return tty->driver->ioctl(tty, file, cmd, arg);
> - return -EINVAL;
> -
> - /* These two ioctl's always return success; even if */
> - /* the driver doesn't support them. */
> - case TCSBRK:
> - case TCSBRKP:
> - if (!tty->driver->ioctl)
> - return 0;
> - retval = tty->driver->ioctl(tty, file, cmd, arg);
> - if (retval == -ENOIOCTLCMD)
> - retval = 0;
> - return retval;
> - }
> - }
> -
> - /*
> - * Factor out some common prep work
> - */
> - switch (cmd) {
> - case TIOCSETD:
> - case TIOCSBRK:
> - case TIOCCBRK:
> - case TCSBRK:
> - case TCSBRKP:
> - retval = tty_check_change(tty);
> - if (retval)
> - return retval;
> - if (cmd != TIOCCBRK) {
> - tty_wait_until_sent(tty, 0);
> - if (signal_pending(current))
> - return -EINTR;
> - }
> - break;
> - }
> -
> - switch (cmd) {
> - case TIOCSTI:
> - return tiocsti(tty, p);
> - case TIOCGWINSZ:
> - return tiocgwinsz(tty, p);
> - case TIOCSWINSZ:
> - return tiocswinsz(tty, real_tty, p);
> - case TIOCCONS:
> - return real_tty!=tty ? -EINVAL : tioccons(file);
> - case FIONBIO:
> - return fionbio(file, p);
> - case TIOCEXCL:
> - set_bit(TTY_EXCLUSIVE, &tty->flags);
> - return 0;
> - case TIOCNXCL:
> - clear_bit(TTY_EXCLUSIVE, &tty->flags);
> - return 0;
> - case TIOCNOTTY:
> - if (current->signal->tty != tty)
> - return -ENOTTY;
> - if (current->signal->leader)
> - disassociate_ctty(0);
> - task_lock(current);
> - current->signal->tty = NULL;
> - task_unlock(current);
> - return 0;
> - case TIOCSCTTY:
> - return tiocsctty(tty, arg);
> - case TIOCGPGRP:
> - return tiocgpgrp(tty, real_tty, p);
> - case TIOCSPGRP:
> - return tiocspgrp(tty, real_tty, p);
> - case TIOCGSID:
> - return tiocgsid(tty, real_tty, p);
> - case TIOCGETD:
> - /* FIXME: check this is ok */
> - return put_user(tty->ldisc.num, (int __user *)p);
> - case TIOCSETD:
> - return tiocsetd(tty, p);
> -#ifdef CONFIG_VT
> - case TIOCLINUX:
> - return tioclinux(tty, arg);
> -#endif
> - /*
> - * Break handling
> - */
> - case TIOCSBRK: /* Turn break on, unconditionally */
> - tty->driver->break_ctl(tty, -1);
> - return 0;
> -
> - case TIOCCBRK: /* Turn break off, unconditionally */
> - tty->driver->break_ctl(tty, 0);
> - return 0;
> - case TCSBRK: /* SVID version: non-zero arg --> no break */
> - /*
> - * XXX is the above comment correct, or the
> - * code below correct? Is this ioctl used at
> - * all by anyone?
> - */
> - if (!arg)
> - return send_break(tty, 250);
> - return 0;
> - case TCSBRKP: /* support for POSIX tcsendbreak() */
> - return send_break(tty, arg ? arg*100 : 250);
> -
> - case TIOCMGET:
> - return tty_tiocmget(tty, file, p);
> -
> - case TIOCMSET:
> - case TIOCMBIC:
> - case TIOCMBIS:
> - return tty_tiocmset(tty, file, cmd, p);
> - }
> - if (tty->driver->ioctl) {
> - retval = (tty->driver->ioctl)(tty, file, cmd, arg);
> - if (retval != -ENOIOCTLCMD)
> - return retval;
> - }
> - ld = tty_ldisc_ref_wait(tty);
> - retval = -EINVAL;
> - if (ld->ioctl) {
> - retval = ld->ioctl(tty, file, cmd, arg);
> - if (retval == -ENOIOCTLCMD)
> - retval = -EINVAL;
> - }
> - tty_ldisc_deref(ld);
> - return retval;
> -}
> -
> -
> -/*
> - * This implements the "Secure Attention Key" --- the idea is to
> - * prevent trojan horses by killing all processes associated with this
> - * tty when the user hits the "Secure Attention Key". Required for
> - * super-paranoid applications --- see the Orange Book for more details.
> - *
> - * This code could be nicer; ideally it should send a HUP, wait a few
> - * seconds, then send a INT, and then a KILL signal. But you then
> - * have to coordinate with the init process, since all processes associated
> - * with the current tty must be dead before the new getty is allowed
> - * to spawn.
> - *
> - * Now, if it would be correct ;-/ The current code has a nasty hole -
> - * it doesn't catch files in flight. We may send the descriptor to ourselves
> - * via AF_UNIX socket, close it and later fetch from socket. FIXME.
> - *
> - * Nasty bug: do_SAK is being called in interrupt context. This can
> - * deadlock. We punt it up to process context. AKPM - 16Mar2001
> - */
> -static void __do_SAK(void *arg)
> -{
> -#ifdef TTY_SOFT_SAK
> - tty_hangup(tty);
> -#else
> - struct tty_struct *tty = arg;
> - struct task_struct *p;
> - int session;
> - int i;
> - struct file *filp;
> - struct tty_ldisc *disc;
> - struct fdtable *fdt;
> -
> - if (!tty)
> - return;
> - session = tty->session;
> -
> - /* We don't want an ldisc switch during this */
> - disc = tty_ldisc_ref(tty);
> - if (disc && disc->flush_buffer)
> - disc->flush_buffer(tty);
> - tty_ldisc_deref(disc);
> -
> - if (tty->driver->flush_buffer)
> - tty->driver->flush_buffer(tty);
> -
> - read_lock(&tasklist_lock);
> - do_each_task_pid(session, PIDTYPE_SID, p) {
> - if (p->signal->tty == tty || session > 0) {
> - printk(KERN_NOTICE "SAK: killed process %d"
> - " (%s): p->signal->session==tty->session\n",
> - p->pid, p->comm);
> - send_sig(SIGKILL, p, 1);
> - continue;
> - }
> - task_lock(p);
> - if (p->files) {
> - /*
> - * We don't take a ref to the file, so we must
> - * hold ->file_lock instead.
> - */
> - spin_lock(&p->files->file_lock);
> - fdt = files_fdtable(p->files);
> - for (i=0; i < fdt->max_fds; i++) {
> - filp = fcheck_files(p->files, i);
> - if (!filp)
> - continue;
> - if (filp->f_op->read == tty_read &&
> - filp->private_data == tty) {
> - printk(KERN_NOTICE "SAK: killed process
> %d"
> - " (%s): fd#%d opened to the tty\n",
> - p->pid, p->comm, i);
> - send_sig(SIGKILL, p, 1);
> - break;
> - }
> - }
> - spin_unlock(&p->files->file_lock);
> - }
> - task_unlock(p);
> - } while_each_task_pid(session, PIDTYPE_SID, p);
> - read_unlock(&tasklist_lock);
> -#endif
> -}
> -
> -/*
> - * The tq handling here is a little racy - tty->SAK_work may already be
> queued.
> - * Fortunately we don't need to worry, because if ->SAK_work is already
> queued,
> - * the values which we write to it will be identical to the values which it
> - * already has. --akpm
> - */
> -void do_SAK(struct tty_struct *tty)
> -{
> - if (!tty)
> - return;
> - PREPARE_WORK(&tty->SAK_work, __do_SAK, tty);
> - schedule_work(&tty->SAK_work);
> -}
> -
> -EXPORT_SYMBOL(do_SAK);
> -
> -/*
> - * This routine is called out of the software interrupt to flush data
> - * from the buffer chain to the line discipline.
> - */
> -
> -static void flush_to_ldisc(void *private_)
> -{
> - struct tty_struct *tty = (struct tty_struct *) private_;
> - unsigned long flags;
> - struct tty_ldisc *disc;
> - struct tty_buffer *tbuf, *head;
> - int count;
> - char *char_buf;
> - unsigned char *flag_buf;
> -
> - disc = tty_ldisc_ref(tty);
> - if (disc == NULL) /* !TTY_LDISC */
> - return;
> -
> - if (test_bit(TTY_DONT_FLIP, &tty->flags)) {
> - /*
> - * Do it after the next timer tick:
> - */
> - schedule_delayed_work(&tty->buf.work, 1);
> - goto out;
> - }
> - spin_lock_irqsave(&tty->buf.lock, flags);
> - head = tty->buf.head;
> - tty->buf.head = NULL;
> - while((tbuf = head) != NULL) {
> - while ((count = tbuf->commit - tbuf->read) != 0) {
> - char_buf = tbuf->char_buf_ptr + tbuf->read;
> - flag_buf = tbuf->flag_buf_ptr + tbuf->read;
> - tbuf->read += count;
> - spin_unlock_irqrestore(&tty->buf.lock, flags);
> - disc->receive_buf(tty, char_buf, flag_buf, count);
> - spin_lock_irqsave(&tty->buf.lock, flags);
> - }
> - if (tbuf->active) {
> - tty->buf.head = head;
> - break;
> - }
> - head = tbuf->next;
> - if (head == NULL)
> - tty->buf.tail = NULL;
> - tty_buffer_free(tty, tbuf);
> - }
> - spin_unlock_irqrestore(&tty->buf.lock, flags);
> -out:
> - tty_ldisc_deref(disc);
> -}
> -
> -/*
> - * Routine which returns the baud rate of the tty
> - *
> - * Note that the baud_table needs to be kept in sync with the
> - * include/asm/termbits.h file.
> - */
> -static int baud_table[] = {
> - 0, 50, 75, 110, 134, 150, 200, 300, 600, 1200, 1800, 2400, 4800,
> - 9600, 19200, 38400, 57600, 115200, 230400, 460800,
> -#ifdef __sparc__
> - 76800, 153600, 307200, 614400, 921600
> -#else
> - 500000, 576000, 921600, 1000000, 1152000, 1500000, 2000000,
> - 2500000, 3000000, 3500000, 4000000
> -#endif
> -};
> -
> -static int n_baud_table = ARRAY_SIZE(baud_table);
> -
> -/**
> - * tty_termios_baud_rate
> - * @termios: termios structure
> - *
> - * Convert termios baud rate data into a speed. This should be called
> - * with the termios lock held if this termios is a terminal termios
> - * structure. May change the termios data.
> - */
> -
> -int tty_termios_baud_rate(struct termios *termios)
> -{
> - unsigned int cbaud;
> -
> - cbaud = termios->c_cflag & CBAUD;
> -
> - if (cbaud & CBAUDEX) {
> - cbaud &= ~CBAUDEX;
> -
> - if (cbaud < 1 || cbaud + 15 > n_baud_table)
> - termios->c_cflag &= ~CBAUDEX;
> - else
> - cbaud += 15;
> - }
> - return baud_table[cbaud];
> -}
> -
> -EXPORT_SYMBOL(tty_termios_baud_rate);
> -
> -/**
> - * tty_get_baud_rate - get tty bit rates
> - * @tty: tty to query
> - *
> - * Returns the baud rate as an integer for this terminal. The
> - * termios lock must be held by the caller and the terminal bit
> - * flags may be updated.
> - */
> -
> -int tty_get_baud_rate(struct tty_struct *tty)
> -{
> - int baud = tty_termios_baud_rate(tty->termios);
> -
> - if (baud == 38400 && tty->alt_speed) {
> - if (!tty->warned) {
> - printk(KERN_WARNING "Use of setserial/setrocket to "
> - "set SPD_* flags is deprecated\n");
> - tty->warned = 1;
> - }
> - baud = tty->alt_speed;
> - }
> -
> - return baud;
> -}
> -
> -EXPORT_SYMBOL(tty_get_baud_rate);
> -
> -/**
> - * tty_flip_buffer_push - terminal
> - * @tty: tty to push
> - *
> - * Queue a push of the terminal flip buffers to the line discipline. This
> - * function must not be called from IRQ context if tty->low_latency is set.
> - *
> - * In the event of the queue being busy for flipping the work will be
> - * held off and retried later.
> - */
> -
> -void tty_flip_buffer_push(struct tty_struct *tty)
> -{
> - unsigned long flags;
> - spin_lock_irqsave(&tty->buf.lock, flags);
> - if (tty->buf.tail != NULL) {
> - tty->buf.tail->active = 0;
> - tty->buf.tail->commit = tty->buf.tail->used;
> - }
> - spin_unlock_irqrestore(&tty->buf.lock, flags);
> -
> - if (tty->low_latency)
> - flush_to_ldisc((void *) tty);
> - else
> - schedule_delayed_work(&tty->buf.work, 1);
> -}
> -
> -EXPORT_SYMBOL(tty_flip_buffer_push);
> -
> -
> -/*
> - * This subroutine initializes a tty structure.
> - */
> -static void initialize_tty_struct(struct tty_struct *tty)
> -{
> - memset(tty, 0, sizeof(struct tty_struct));
> - tty->magic = TTY_MAGIC;
> - tty_ldisc_assign(tty, tty_ldisc_get(N_TTY));
> - tty->pgrp = -1;
> - tty->overrun_time = jiffies;
> - tty->buf.head = tty->buf.tail = NULL;
> - tty_buffer_init(tty);
> - INIT_WORK(&tty->buf.work, flush_to_ldisc, tty);
> - init_MUTEX(&tty->buf.pty_sem);
> - init_MUTEX(&tty->termios_sem);
> - init_waitqueue_head(&tty->write_wait);
> - init_waitqueue_head(&tty->read_wait);
> - INIT_WORK(&tty->hangup_work, do_tty_hangup, tty);
> - sema_init(&tty->atomic_read, 1);
> - sema_init(&tty->atomic_write, 1);
> - spin_lock_init(&tty->read_lock);
> - INIT_LIST_HEAD(&tty->tty_files);
> - INIT_WORK(&tty->SAK_work, NULL, NULL);
> -}
> -
> -/*
> - * The default put_char routine if the driver did not define one.
> - */
> -static void tty_default_put_char(struct tty_struct *tty, unsigned char ch)
> -{
> - tty->driver->write(tty, &ch, 1);
> -}
> -
> -static struct class *tty_class;
> -
> -/**
> - * tty_register_device - register a tty device
> - * @driver: the tty driver that describes the tty device
> - * @index: the index in the tty driver for this tty device
> - * @device: a struct device that is associated with this tty device.
> - * This field is optional, if there is no known struct device for this
> - * tty device it can be set to NULL safely.
> - *
> - * This call is required to be made to register an individual tty device if
> - * the tty driver's flags have the TTY_DRIVER_NO_DEVFS bit set. If that
> - * bit is not set, this function should not be called.
> - */
> -void tty_register_device(struct tty_driver *driver, unsigned index,
> - struct device *device)
> -{
> - char name[64];
> - dev_t dev = MKDEV(driver->major, driver->minor_start) + index;
> -
> - if (index >= driver->num) {
> - printk(KERN_ERR "Attempt to register invalid tty line number "
> - " (%d).\n", index);
> - return;
> - }
> -
> - devfs_mk_cdev(dev, S_IFCHR | S_IRUSR | S_IWUSR,
> - "%s%d", driver->devfs_name, index + driver->name_base);
> -
> - if (driver->type == TTY_DRIVER_TYPE_PTY)
> - pty_line_name(driver, index, name);
> - else
> - tty_line_name(driver, index, name);
> - class_device_create(tty_class, NULL, dev, device, "%s", name);
> -}
> -
> -/**
> - * tty_unregister_device - unregister a tty device
> - * @driver: the tty driver that describes the tty device
> - * @index: the index in the tty driver for this tty device
> - *
> - * If a tty device is registered with a call to tty_register_device() then
> - * this function must be made when the tty device is gone.
> - */
> -void tty_unregister_device(struct tty_driver *driver, unsigned index)
> -{
> - devfs_remove("%s%d", driver->devfs_name, index + driver->name_base);
> - class_device_destroy(tty_class, MKDEV(driver->major,
> driver->minor_start) + index);
> -}
> -
> -EXPORT_SYMBOL(tty_register_device);
> -EXPORT_SYMBOL(tty_unregister_device);
> -
> -struct tty_driver *alloc_tty_driver(int lines)
> -{
> - struct tty_driver *driver;
> -
> - driver = kmalloc(sizeof(struct tty_driver), GFP_KERNEL);
> - if (driver) {
> - memset(driver, 0, sizeof(struct tty_driver));
> - driver->magic = TTY_DRIVER_MAGIC;
> - driver->num = lines;
> - /* later we'll move allocation of tables here */
> - }
> - return driver;
> -}
> -
> -void put_tty_driver(struct tty_driver *driver)
> -{
> - kfree(driver);
> -}
> -
> -void tty_set_operations(struct tty_driver *driver, struct tty_operations *op)
> -{
> - driver->open = op->open;
> - driver->close = op->close;
> - driver->write = op->write;
> - driver->put_char = op->put_char;
> - driver->flush_chars = op->flush_chars;
> - driver->write_room = op->write_room;
> - driver->chars_in_buffer = op->chars_in_buffer;
> - driver->ioctl = op->ioctl;
> - driver->set_termios = op->set_termios;
> - driver->throttle = op->throttle;
> - driver->unthrottle = op->unthrottle;
> - driver->stop = op->stop;
> - driver->start = op->start;
> - driver->hangup = op->hangup;
> - driver->break_ctl = op->break_ctl;
> - driver->flush_buffer = op->flush_buffer;
> - driver->set_ldisc = op->set_ldisc;
> - driver->wait_until_sent = op->wait_until_sent;
> - driver->send_xchar = op->send_xchar;
> - driver->read_proc = op->read_proc;
> - driver->write_proc = op->write_proc;
> - driver->tiocmget = op->tiocmget;
> - driver->tiocmset = op->tiocmset;
> -}
> -
> -
> -EXPORT_SYMBOL(alloc_tty_driver);
> -EXPORT_SYMBOL(put_tty_driver);
> -EXPORT_SYMBOL(tty_set_operations);
> -
> -/*
> - * Called by a tty driver to register itself.
> - */
> -int tty_register_driver(struct tty_driver *driver)
> -{
> - int error;
> - int i;
> - dev_t dev;
> - void **p = NULL;
> -
> - if (driver->flags & TTY_DRIVER_INSTALLED)
> - return 0;
> -
> - if (!(driver->flags & TTY_DRIVER_DEVPTS_MEM)) {
> - p = kmalloc(driver->num * 3 * sizeof(void *), GFP_KERNEL);
> - if (!p)
> - return -ENOMEM;
> - memset(p, 0, driver->num * 3 * sizeof(void *));
> - }
> -
> - if (!driver->major) {
> - error = alloc_chrdev_region(&dev, driver->minor_start,
> driver->num,
> - (char*)driver->name);
> - if (!error) {
> - driver->major = MAJOR(dev);
> - driver->minor_start = MINOR(dev);
> - }
> - } else {
> - dev = MKDEV(driver->major, driver->minor_start);
> - error = register_chrdev_region(dev, driver->num,
> - (char*)driver->name);
> - }
> - if (error < 0) {
> - kfree(p);
> - return error;
> - }
> -
> - if (p) {
> - driver->ttys = (struct tty_struct **)p;
> - driver->termios = (struct termios **)(p + driver->num);
> - driver->termios_locked = (struct termios **)(p + driver->num *
> 2);
> - } else {
> - driver->ttys = NULL;
> - driver->termios = NULL;
> - driver->termios_locked = NULL;
> - }
> -
> - cdev_init(&driver->cdev, &tty_fops);
> - driver->cdev.owner = driver->owner;
> - error = cdev_add(&driver->cdev, dev, driver->num);
> - if (error) {
> - cdev_del(&driver->cdev);
> - unregister_chrdev_region(dev, driver->num);
> - driver->ttys = NULL;
> - driver->termios = driver->termios_locked = NULL;
> - kfree(p);
> - return error;
> - }
> -
> - if (!driver->put_char)
> - driver->put_char = tty_default_put_char;
> -
> - list_add(&driver->tty_drivers, &tty_drivers);
> -
> - if ( !(driver->flags & TTY_DRIVER_NO_DEVFS) ) {
> - for(i = 0; i < driver->num; i++)
> - tty_register_device(driver, i, NULL);
> - }
> - proc_tty_register_driver(driver);
> - return 0;
> -}
> -
> -EXPORT_SYMBOL(tty_register_driver);
> -
> -/*
> - * Called by a tty driver to unregister itself.
> - */
> -int tty_unregister_driver(struct tty_driver *driver)
> -{
> - int i;
> - struct termios *tp;
> - void *p;
> -
> - if (driver->refcount)
> - return -EBUSY;
> -
> - unregister_chrdev_region(MKDEV(driver->major, driver->minor_start),
> - driver->num);
> -
> - list_del(&driver->tty_drivers);
> -
> - /*
> - * Free the termios and termios_locked structures because
> - * we don't want to get memory leaks when modular tty
> - * drivers are removed from the kernel.
> - */
> - for (i = 0; i < driver->num; i++) {
> - tp = driver->termios[i];
> - if (tp) {
> - driver->termios[i] = NULL;
> - kfree(tp);
> - }
> - tp = driver->termios_locked[i];
> - if (tp) {
> - driver->termios_locked[i] = NULL;
> - kfree(tp);
> - }
> - if (!(driver->flags & TTY_DRIVER_NO_DEVFS))
> - tty_unregister_device(driver, i);
> - }
> - p = driver->ttys;
> - proc_tty_unregister_driver(driver);
> - driver->ttys = NULL;
> - driver->termios = driver->termios_locked = NULL;
> - kfree(p);
> - cdev_del(&driver->cdev);
> - return 0;
> -}
> -
> -EXPORT_SYMBOL(tty_unregister_driver);
> -
> -
> -/*
> - * Initialize the console device. This is called *early*, so
> - * we can't necessarily depend on lots of kernel help here.
> - * Just do some early initializations, and do the complex setup
> - * later.
> - */
> -void __init console_init(void)
> -{
> - initcall_t *call;
> -
> - /* Setup the default TTY line discipline. */
> - (void) tty_register_ldisc(N_TTY, &tty_ldisc_N_TTY);
> -
> - /*
> - * set up the console device so that later boot sequences can
> - * inform about problems etc..
> - */
> -#ifdef CONFIG_EARLY_PRINTK
> - disable_early_printk();
> -#endif
> - call = __con_initcall_start;
> - while (call < __con_initcall_end) {
> - (*call)();
> - call++;
> - }
> -}
> -
> -#ifdef CONFIG_VT
> -extern int vty_init(void);
> -#endif
> -
> -static int __init tty_class_init(void)
> -{
> - tty_class = class_create(THIS_MODULE, "tty");
> - if (IS_ERR(tty_class))
> - return PTR_ERR(tty_class);
> - return 0;
> -}
> -
> -postcore_initcall(tty_class_init);
> -
> -/* 3/2004 jmc: why do these devices exist? */
> -
> -static struct cdev tty_cdev, console_cdev;
> -#ifdef CONFIG_UNIX98_PTYS
> -static struct cdev ptmx_cdev;
> -#endif
> -#ifdef CONFIG_VT
> -static struct cdev vc0_cdev;
> -#endif
> -
> -/*
> - * Ok, now we can initialize the rest of the tty devices and can count
> - * on memory allocations, interrupts etc..
> - */
> -static int __init tty_init(void)
> -{
> - cdev_init(&tty_cdev, &tty_fops);
> - if (cdev_add(&tty_cdev, MKDEV(TTYAUX_MAJOR, 0), 1) ||
> - register_chrdev_region(MKDEV(TTYAUX_MAJOR, 0), 1, "/dev/tty") < 0)
> - panic("Couldn't register /dev/tty driver\n");
> - devfs_mk_cdev(MKDEV(TTYAUX_MAJOR, 0), S_IFCHR|S_IRUGO|S_IWUGO, "tty");
> - class_device_create(tty_class, NULL, MKDEV(TTYAUX_MAJOR, 0), NULL,
> "tty");
> -
> - cdev_init(&console_cdev, &console_fops);
> - if (cdev_add(&console_cdev, MKDEV(TTYAUX_MAJOR, 1), 1) ||
> - register_chrdev_region(MKDEV(TTYAUX_MAJOR, 1), 1, "/dev/console") <
> 0)
> - panic("Couldn't register /dev/console driver\n");
> - devfs_mk_cdev(MKDEV(TTYAUX_MAJOR, 1), S_IFCHR|S_IRUSR|S_IWUSR,
> "console");
> - class_device_create(tty_class, NULL, MKDEV(TTYAUX_MAJOR, 1), NULL,
> "console");
> -
> -#ifdef CONFIG_UNIX98_PTYS
> - cdev_init(&ptmx_cdev, &ptmx_fops);
> - if (cdev_add(&ptmx_cdev, MKDEV(TTYAUX_MAJOR, 2), 1) ||
> - register_chrdev_region(MKDEV(TTYAUX_MAJOR, 2), 1, "/dev/ptmx") < 0)
> - panic("Couldn't register /dev/ptmx driver\n");
> - devfs_mk_cdev(MKDEV(TTYAUX_MAJOR, 2), S_IFCHR|S_IRUGO|S_IWUGO, "ptmx");
> - class_device_create(tty_class, NULL, MKDEV(TTYAUX_MAJOR, 2), NULL,
> "ptmx");
> -#endif
> -
> -#ifdef CONFIG_VT
> - if (!console_use_vt)
> - goto out_vt;
> - cdev_init(&vc0_cdev, &console_fops);
> - if (cdev_add(&vc0_cdev, MKDEV(TTY_MAJOR, 0), 1) ||
> - register_chrdev_region(MKDEV(TTY_MAJOR, 0), 1, "/dev/vc/0") < 0)
> - panic("Couldn't register /dev/tty0 driver\n");
> - devfs_mk_cdev(MKDEV(TTY_MAJOR, 0), S_IFCHR|S_IRUSR|S_IWUSR, "vc/0");
> - class_device_create(tty_class, NULL, MKDEV(TTY_MAJOR, 0), NULL, "tty0");
> -
> - vty_init();
> - out_vt:
> -#endif
> - return 0;
> -}
> -module_init(tty_init);
>
> _______________________________________________
> Xen-devel mailing list
> Xen-devel@xxxxxxxxxxxxxxxxxxx
> http://lists.xensource.com/xen-devel
Attachment:
signature.asc _______________________________________________ Xen-devel mailing list Xen-devel@xxxxxxxxxxxxxxxxxxx http://lists.xensource.com/xen-devel
|
 |
Lists.xenproject.org is hosted with RackSpace, monitoring our |