cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

parport_cs.c (5661B)


      1/*======================================================================
      2
      3    A driver for PCMCIA parallel port adapters
      4
      5    (specifically, for the Quatech SPP-100 EPP card: other cards will
      6    probably require driver tweaks)
      7    
      8    parport_cs.c 1.29 2002/10/11 06:57:41
      9
     10    The contents of this file are subject to the Mozilla Public
     11    License Version 1.1 (the "License"); you may not use this file
     12    except in compliance with the License. You may obtain a copy of
     13    the License at http://www.mozilla.org/MPL/
     14
     15    Software distributed under the License is distributed on an "AS
     16    IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
     17    implied. See the License for the specific language governing
     18    rights and limitations under the License.
     19
     20    The initial developer of the original code is David A. Hinds
     21    <dahinds@users.sourceforge.net>.  Portions created by David A. Hinds
     22    are Copyright (C) 1999 David A. Hinds.  All Rights Reserved.
     23
     24    Alternatively, the contents of this file may be used under the
     25    terms of the GNU General Public License version 2 (the "GPL"), in
     26    which case the provisions of the GPL are applicable instead of the
     27    above.  If you wish to allow the use of your version of this file
     28    only under the terms of the GPL and not to allow others to use
     29    your version of this file under the MPL, indicate your decision
     30    by deleting the provisions above and replace them with the notice
     31    and other provisions required by the GPL.  If you do not delete
     32    the provisions above, a recipient may use your version of this
     33    file under either the MPL or the GPL.
     34    
     35======================================================================*/
     36
     37#include <linux/kernel.h>
     38#include <linux/module.h>
     39#include <linux/init.h>
     40#include <linux/ptrace.h>
     41#include <linux/slab.h>
     42#include <linux/string.h>
     43#include <linux/timer.h>
     44#include <linux/ioport.h>
     45#include <linux/major.h>
     46#include <linux/interrupt.h>
     47
     48#include <linux/parport.h>
     49#include <linux/parport_pc.h>
     50
     51#include <pcmcia/cistpl.h>
     52#include <pcmcia/ds.h>
     53#include <pcmcia/cisreg.h>
     54#include <pcmcia/ciscode.h>
     55
     56/*====================================================================*/
     57
     58/* Module parameters */
     59
     60MODULE_AUTHOR("David Hinds <dahinds@users.sourceforge.net>");
     61MODULE_DESCRIPTION("PCMCIA parallel port card driver");
     62MODULE_LICENSE("Dual MPL/GPL");
     63
     64#define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0)
     65
     66INT_MODULE_PARM(epp_mode, 1);
     67
     68
     69/*====================================================================*/
     70
     71#define FORCE_EPP_MODE	0x08
     72
     73typedef struct parport_info_t {
     74	struct pcmcia_device	*p_dev;
     75    int			ndev;
     76    struct parport	*port;
     77} parport_info_t;
     78
     79static void parport_detach(struct pcmcia_device *p_dev);
     80static int parport_config(struct pcmcia_device *link);
     81static void parport_cs_release(struct pcmcia_device *);
     82
     83static int parport_probe(struct pcmcia_device *link)
     84{
     85    parport_info_t *info;
     86
     87    dev_dbg(&link->dev, "parport_attach()\n");
     88
     89    /* Create new parport device */
     90    info = kzalloc(sizeof(*info), GFP_KERNEL);
     91    if (!info) return -ENOMEM;
     92    link->priv = info;
     93    info->p_dev = link;
     94
     95    link->config_flags |= CONF_ENABLE_IRQ | CONF_AUTO_SET_IO;
     96
     97    return parport_config(link);
     98} /* parport_attach */
     99
    100static void parport_detach(struct pcmcia_device *link)
    101{
    102    dev_dbg(&link->dev, "parport_detach\n");
    103
    104    parport_cs_release(link);
    105
    106    kfree(link->priv);
    107} /* parport_detach */
    108
    109static int parport_config_check(struct pcmcia_device *p_dev, void *priv_data)
    110{
    111	p_dev->resource[0]->flags &= ~IO_DATA_PATH_WIDTH;
    112	p_dev->resource[0]->flags |= IO_DATA_PATH_WIDTH_8;
    113	p_dev->resource[1]->flags &= ~IO_DATA_PATH_WIDTH;
    114	p_dev->resource[1]->flags |= IO_DATA_PATH_WIDTH_8;
    115
    116	return pcmcia_request_io(p_dev);
    117}
    118
    119static int parport_config(struct pcmcia_device *link)
    120{
    121    parport_info_t *info = link->priv;
    122    struct parport *p;
    123    int ret;
    124
    125    dev_dbg(&link->dev, "parport_config\n");
    126
    127    if (epp_mode)
    128	    link->config_index |= FORCE_EPP_MODE;
    129
    130    ret = pcmcia_loop_config(link, parport_config_check, NULL);
    131    if (ret)
    132	    goto failed;
    133
    134    if (!link->irq)
    135	    goto failed;
    136    ret = pcmcia_enable_device(link);
    137    if (ret)
    138	    goto failed;
    139
    140    p = parport_pc_probe_port(link->resource[0]->start,
    141			      link->resource[1]->start,
    142			      link->irq, PARPORT_DMA_NONE,
    143			      &link->dev, IRQF_SHARED);
    144    if (p == NULL) {
    145	    pr_notice("parport_cs: parport_pc_probe_port() at 0x%3x, irq %u failed\n",
    146		      (unsigned int)link->resource[0]->start, link->irq);
    147	goto failed;
    148    }
    149
    150    p->modes |= PARPORT_MODE_PCSPP;
    151    if (epp_mode)
    152	p->modes |= PARPORT_MODE_TRISTATE | PARPORT_MODE_EPP;
    153    info->ndev = 1;
    154    info->port = p;
    155
    156    return 0;
    157
    158failed:
    159	parport_cs_release(link);
    160	kfree(link->priv);
    161	return -ENODEV;
    162} /* parport_config */
    163
    164static void parport_cs_release(struct pcmcia_device *link)
    165{
    166	parport_info_t *info = link->priv;
    167
    168	dev_dbg(&link->dev, "parport_release\n");
    169
    170	if (info->ndev) {
    171		struct parport *p = info->port;
    172		parport_pc_unregister_port(p);
    173	}
    174	info->ndev = 0;
    175
    176	pcmcia_disable_device(link);
    177} /* parport_cs_release */
    178
    179
    180static const struct pcmcia_device_id parport_ids[] = {
    181	PCMCIA_DEVICE_FUNC_ID(3),
    182	PCMCIA_MFC_DEVICE_PROD_ID12(1,"Elan","Serial+Parallel Port: SP230",0x3beb8cf2,0xdb9e58bc),
    183	PCMCIA_DEVICE_MANF_CARD(0x0137, 0x0003),
    184	PCMCIA_DEVICE_NULL
    185};
    186MODULE_DEVICE_TABLE(pcmcia, parport_ids);
    187
    188static struct pcmcia_driver parport_cs_driver = {
    189	.owner		= THIS_MODULE,
    190	.name		= "parport_cs",
    191	.probe		= parport_probe,
    192	.remove		= parport_detach,
    193	.id_table	= parport_ids,
    194};
    195module_pcmcia_driver(parport_cs_driver);