SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/net/can/sja1000/ems_pci.c

   1 /*
   2  * Copyright (C) 2007 Wolfgang Grandegger <wg@grandegger.com>
   3  * Copyright (C) 2008 Markus Plessing <plessing@ems-wuensche.com>
   4  * Copyright (C) 2008 Sebastian Haas <haas@ems-wuensche.com>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the version 2 of the GNU General Public License
   8  * as published by the Free Software Foundation
   9  *
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13  * GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this program; if not, write to the Free Software Foundation,
  17  * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  18  */
  19
  20 #include <linux/kernel.h>
  21 #include <linux/module.h>
  22 #include <linux/interrupt.h>
  23 #include <linux/netdevice.h>
  24 #include <linux/delay.h>
  25 #include <linux/pci.h>
  26 #include <linux/can.h>
  27 #include <linux/can/dev.h>
  28 #include <linux/io.h>
  29
  30 #include "sja1000.h"
  31
  32 #define DRV_NAME  "ems_pci"
  33
  34 MODULE_AUTHOR("Sebastian Haas <haas@ems-wuenche.com>");
  35 MODULE_DESCRIPTION("Socket-CAN driver for EMS CPC-PCI/PCIe CAN cards");
  36 MODULE_SUPPORTED_DEVICE("EMS CPC-PCI/PCIe CAN card");
  37 MODULE_LICENSE("GPL v2");
  38
  39 #define EMS_PCI_MAX_CHAN 2
  40
  41 struct ems_pci_card {
  42         int channels;
  43
  44         struct pci_dev *pci_dev;
  45         struct net_device *net_dev[EMS_PCI_MAX_CHAN];
  46
  47         void __iomem *conf_addr;
  48         void __iomem *base_addr;
  49 };
  50
  51 #define EMS_PCI_CAN_CLOCK (16000000 / 2)
  52
  53 /*
  54  * Register definitions and descriptions are from LinCAN 0.3.3.
  55  *
  56  * PSB4610 PITA-2 bridge control registers
  57  */
  58 #define PITA2_ICR           0x00        /* Interrupt Control Register */
  59 #define PITA2_ICR_INT0      0x00000002  /* [RC] INT0 Active/Clear */
  60 #define PITA2_ICR_INT0_EN   0x00020000  /* [RW] Enable INT0 */
  61
  62 #define PITA2_MISC          0x1c        /* Miscellaneous Register */
  63 #define PITA2_MISC_CONFIG   0x04000000  /* Multiplexed parallel interface */
  64
  65 /*
  66  * The board configuration is probably following:
  67  * RX1 is connected to ground.
  68  * TX1 is not connected.
  69  * CLKO is not connected.
  70  * Setting the OCR register to 0xDA is a good idea.
  71  * This means  normal output mode , push-pull and the correct polarity.
  72  */
  73 #define EMS_PCI_OCR         (OCR_TX0_PUSHPULL | OCR_TX1_PUSHPULL)
  74
  75 /*
  76  * In the CDR register, you should set CBP to 1.
  77  * You will probably also want to set the clock divider value to 7
  78  * (meaning direct oscillator output) because the second SJA1000 chip
  79  * is driven by the first one CLKOUT output.
  80  */
  81 #define EMS_PCI_CDR             (CDR_CBP | CDR_CLKOUT_MASK)
  82 #define EMS_PCI_MEM_SIZE        4096  /* Size of the remapped io-memory */
  83 #define EMS_PCI_CAN_BASE_OFFSET 0x400 /* offset where the controllers starts */
  84 #define EMS_PCI_CAN_CTRL_SIZE   0x200 /* memory size for each controller */
  85
  86 #define EMS_PCI_PORT_BYTES  0x4     /* Each register occupies 4 bytes */
  87
  88 #define EMS_PCI_VENDOR_ID   0x110a  /* PCI device and vendor ID */
  89 #define EMS_PCI_DEVICE_ID   0x2104
  90
  91 static struct pci_device_id ems_pci_tbl[] = {
  92         {EMS_PCI_VENDOR_ID, EMS_PCI_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID,},
  93         {0,}
  94 };
  95 MODULE_DEVICE_TABLE(pci, ems_pci_tbl);
  96
  97 /*
  98  * Helper to read internal registers from card logic (not CAN)
  99  */
 100 static u8 ems_pci_readb(struct ems_pci_card *card, unsigned int port)
 101 {
 102         return readb((void __iomem *)card->base_addr
 103                         + (port * EMS_PCI_PORT_BYTES));
 104 }
 105
 106 static u8 ems_pci_read_reg(const struct net_device *dev, int port)
 107 {
 108         return readb((void __iomem *)dev->base_addr
 109                         + (port * EMS_PCI_PORT_BYTES));
 110 }
 111
 112 static void ems_pci_write_reg(const struct net_device *dev, int port, u8 val)
 113 {
 114         writeb(val, (void __iomem *)dev->base_addr
 115                 + (port * EMS_PCI_PORT_BYTES));
 116 }
 117
 118 static void ems_pci_post_irq(const struct net_device *dev)
 119 {
 120         struct sja1000_priv *priv = netdev_priv(dev);
 121         struct ems_pci_card *card = (struct ems_pci_card *)priv->priv;
 122
 123         /* reset int flag of pita */
 124         writel(PITA2_ICR_INT0_EN | PITA2_ICR_INT0, card->conf_addr
 125                 + PITA2_ICR);
 126 }
 127
 128 /*
 129  * Check if a CAN controller is present at the specified location
 130  * by trying to set 'em into the PeliCAN mode
 131  */
 132 static inline int ems_pci_check_chan(struct net_device *dev)
 133 {
 134         unsigned char res;
 135
 136         /* Make sure SJA1000 is in reset mode */
 137         ems_pci_write_reg(dev, REG_MOD, 1);
 138
 139         ems_pci_write_reg(dev, REG_CDR, CDR_PELICAN);
 140
 141         /* read reset-values */
 142         res = ems_pci_read_reg(dev, REG_CDR);
 143
 144         if (res == CDR_PELICAN)
 145                 return 1;
 146
 147         return 0;
 148 }
 149
 150 static void ems_pci_del_card(struct pci_dev *pdev)
 151 {
 152         struct ems_pci_card *card = pci_get_drvdata(pdev);
 153         struct net_device *dev;
 154         int i = 0;
 155
 156         for (i = 0; i < card->channels; i++) {
 157                 dev = card->net_dev[i];
 158
 159                 if (!dev)
 160                         continue;
 161
 162                 dev_info(&pdev->dev, "Removing %s.\n", dev->name);
 163                 unregister_sja1000dev(dev);
 164                 free_sja1000dev(dev);
 165         }
 166
 167         if (card->base_addr != NULL)
 168                 pci_iounmap(card->pci_dev, card->base_addr);
 169
 170         if (card->conf_addr != NULL)
 171                 pci_iounmap(card->pci_dev, card->conf_addr);
 172
 173         kfree(card);
 174
 175         pci_disable_device(pdev);
 176         pci_set_drvdata(pdev, NULL);
 177 }
 178
 179 static void ems_pci_card_reset(struct ems_pci_card *card)
 180 {
 181         /* Request board reset */
 182         writeb(0, card->base_addr);
 183 }
 184
 185 /*
 186  * Probe PCI device for EMS CAN signature and register each available
 187  * CAN channel to SJA1000 Socket-CAN subsystem.
 188  */
 189 static int __devinit ems_pci_add_card(struct pci_dev *pdev,
 190                                         const struct pci_device_id *ent)
 191 {
 192         struct sja1000_priv *priv;
 193         struct net_device *dev;
 194         struct ems_pci_card *card;
 195         int err, i;
 196
 197         /* Enabling PCI device */
 198         if (pci_enable_device(pdev) < 0) {
 199                 dev_err(&pdev->dev, "Enabling PCI device failed\n");
 200                 return -ENODEV;
 201         }
 202
 203         /* Allocating card structures to hold addresses, ... */
 204         card = kzalloc(sizeof(struct ems_pci_card), GFP_KERNEL);
 205         if (card == NULL) {
 206                 dev_err(&pdev->dev, "Unable to allocate memory\n");
 207                 pci_disable_device(pdev);
 208                 return -ENOMEM;
 209         }
 210
 211         pci_set_drvdata(pdev, card);
 212
 213         card->pci_dev = pdev;
 214
 215         card->channels = 0;
 216
 217         /* Remap PITA configuration space, and controller memory area */
 218         card->conf_addr = pci_iomap(pdev, 0, EMS_PCI_MEM_SIZE);
 219         if (card->conf_addr == NULL) {
 220                 err = -ENOMEM;
 221
 222                 goto failure_cleanup;
 223         }
 224
 225         card->base_addr = pci_iomap(pdev, 1, EMS_PCI_MEM_SIZE);
 226         if (card->base_addr == NULL) {
 227                 err = -ENOMEM;
 228
 229                 goto failure_cleanup;
 230         }
 231
 232         /* Configure PITA-2 parallel interface (enable MUX) */
 233         writel(PITA2_MISC_CONFIG, card->conf_addr + PITA2_MISC);
 234
 235         /* Check for unique EMS CAN signature */
 236         if (ems_pci_readb(card, 0) != 0x55 ||
 237             ems_pci_readb(card, 1) != 0xAA ||
 238             ems_pci_readb(card, 2) != 0x01 ||
 239             ems_pci_readb(card, 3) != 0xCB ||
 240             ems_pci_readb(card, 4) != 0x11) {
 241                 dev_err(&pdev->dev, "Not EMS Dr. Thomas Wuensche interface\n");
 242
 243                 err = -ENODEV;
 244                 goto failure_cleanup;
 245         }
 246
 247         ems_pci_card_reset(card);
 248
 249         /* Detect available channels */
 250         for (i = 0; i < EMS_PCI_MAX_CHAN; i++) {
 251                 dev = alloc_sja1000dev(0);
 252                 if (dev == NULL) {
 253                         err = -ENOMEM;
 254                         goto failure_cleanup;
 255                 }
 256
 257                 card->net_dev[i] = dev;
 258                 priv = netdev_priv(dev);
 259                 priv->priv = card;
 260                 priv->irq_flags = IRQF_SHARED;
 261
 262                 dev->irq = pdev->irq;
 263                 dev->base_addr = (unsigned long)(card->base_addr
 264                                                 + EMS_PCI_CAN_BASE_OFFSET
 265                                                 + (i * EMS_PCI_CAN_CTRL_SIZE));
 266
 267                 /* Check if channel is present */
 268                 if (ems_pci_check_chan(dev)) {
 269                         priv->read_reg  = ems_pci_read_reg;
 270                         priv->write_reg = ems_pci_write_reg;
 271                         priv->post_irq  = ems_pci_post_irq;
 272                         priv->can.clock.freq = EMS_PCI_CAN_CLOCK;
 273                         priv->ocr = EMS_PCI_OCR;
 274                         priv->cdr = EMS_PCI_CDR;
 275
 276                         SET_NETDEV_DEV(dev, &pdev->dev);
 277
 278                         /* Enable interrupts from card */
 279                         writel(PITA2_ICR_INT0_EN, card->conf_addr + PITA2_ICR);
 280
 281                         /* Register SJA1000 device */
 282                         err = register_sja1000dev(dev);
 283                         if (err) {
 284                                 dev_err(&pdev->dev, "Registering device failed "
 285                                                         "(err=%d)\n", err);
 286                                 free_sja1000dev(dev);
 287                                 goto failure_cleanup;
 288                         }
 289
 290                         card->channels++;
 291
 292                         dev_info(&pdev->dev, "Channel #%d at %#lX, irq %d\n",
 293                                                 i + 1, dev->base_addr,
 294                                                 dev->irq);
 295                 } else {
 296                         free_sja1000dev(dev);
 297                 }
 298         }
 299
 300         return 0;
 301
 302 failure_cleanup:
 303         dev_err(&pdev->dev, "Error: %d. Cleaning Up.\n", err);
 304
 305         ems_pci_del_card(pdev);
 306
 307         return err;
 308 }
 309
 310 static struct pci_driver ems_pci_driver = {
 311         .name = DRV_NAME,
 312         .id_table = ems_pci_tbl,
 313         .probe = ems_pci_add_card,
 314         .remove = ems_pci_del_card,
 315 };
 316
 317 static int __init ems_pci_init(void)
 318 {
 319         return pci_register_driver(&ems_pci_driver);
 320 }
 321
 322 static void __exit ems_pci_exit(void)
 323 {
 324         pci_unregister_driver(&ems_pci_driver);
 325 }
 326
 327 module_init(ems_pci_init);
 328 module_exit(ems_pci_exit);
 329