mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-05 18:14:07 +08:00
9c4b60fe53
When struct moxa8250_board is allocated, then num_ports should be initialized in order to use it later in moxa8250_remove. Signed-off-by: Matwey V. Kornilov <matwey@sai.msu.ru> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
159 lines
4.3 KiB
C
159 lines
4.3 KiB
C
/*
|
|
* 8250_moxa.c - MOXA Smartio/Industio MUE multiport serial driver.
|
|
*
|
|
* Author: Mathieu OTHACEHE <m.othacehe@gmail.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/pci.h>
|
|
|
|
#include "8250.h"
|
|
|
|
#define PCI_DEVICE_ID_MOXA_CP102E 0x1024
|
|
#define PCI_DEVICE_ID_MOXA_CP102EL 0x1025
|
|
#define PCI_DEVICE_ID_MOXA_CP104EL_A 0x1045
|
|
#define PCI_DEVICE_ID_MOXA_CP114EL 0x1144
|
|
#define PCI_DEVICE_ID_MOXA_CP116E_A_A 0x1160
|
|
#define PCI_DEVICE_ID_MOXA_CP116E_A_B 0x1161
|
|
#define PCI_DEVICE_ID_MOXA_CP118EL_A 0x1182
|
|
#define PCI_DEVICE_ID_MOXA_CP118E_A_I 0x1183
|
|
#define PCI_DEVICE_ID_MOXA_CP132EL 0x1322
|
|
#define PCI_DEVICE_ID_MOXA_CP134EL_A 0x1342
|
|
#define PCI_DEVICE_ID_MOXA_CP138E_A 0x1381
|
|
#define PCI_DEVICE_ID_MOXA_CP168EL_A 0x1683
|
|
|
|
#define MOXA_BASE_BAUD 921600
|
|
#define MOXA_UART_OFFSET 0x200
|
|
#define MOXA_BASE_BAR 1
|
|
|
|
struct moxa8250_board {
|
|
unsigned int num_ports;
|
|
int line[0];
|
|
};
|
|
|
|
enum {
|
|
moxa8250_2p = 0,
|
|
moxa8250_4p,
|
|
moxa8250_8p
|
|
};
|
|
|
|
static struct moxa8250_board moxa8250_boards[] = {
|
|
[moxa8250_2p] = { .num_ports = 2},
|
|
[moxa8250_4p] = { .num_ports = 4},
|
|
[moxa8250_8p] = { .num_ports = 8},
|
|
};
|
|
|
|
static int moxa8250_probe(struct pci_dev *pdev, const struct pci_device_id *id)
|
|
{
|
|
struct uart_8250_port uart;
|
|
struct moxa8250_board *brd;
|
|
void __iomem *ioaddr;
|
|
resource_size_t baseaddr;
|
|
unsigned int i, nr_ports;
|
|
unsigned int offset;
|
|
int ret;
|
|
|
|
brd = &moxa8250_boards[id->driver_data];
|
|
nr_ports = brd->num_ports;
|
|
|
|
ret = pcim_enable_device(pdev);
|
|
if (ret)
|
|
return ret;
|
|
|
|
brd = devm_kzalloc(&pdev->dev, sizeof(struct moxa8250_board) +
|
|
sizeof(unsigned int) * nr_ports, GFP_KERNEL);
|
|
if (!brd)
|
|
return -ENOMEM;
|
|
brd->num_ports = nr_ports;
|
|
|
|
memset(&uart, 0, sizeof(struct uart_8250_port));
|
|
|
|
uart.port.dev = &pdev->dev;
|
|
uart.port.irq = pdev->irq;
|
|
uart.port.uartclk = MOXA_BASE_BAUD * 16;
|
|
uart.port.flags = UPF_SKIP_TEST | UPF_BOOT_AUTOCONF | UPF_SHARE_IRQ;
|
|
|
|
baseaddr = pci_resource_start(pdev, MOXA_BASE_BAR);
|
|
ioaddr = pcim_iomap(pdev, MOXA_BASE_BAR, 0);
|
|
if (!ioaddr)
|
|
return -ENOMEM;
|
|
|
|
for (i = 0; i < nr_ports; i++) {
|
|
|
|
/*
|
|
* MOXA Smartio MUE boards with 4 ports have
|
|
* a different offset for port #3
|
|
*/
|
|
if (nr_ports == 4 && i == 3)
|
|
offset = 7 * MOXA_UART_OFFSET;
|
|
else
|
|
offset = i * MOXA_UART_OFFSET;
|
|
|
|
uart.port.iotype = UPIO_MEM;
|
|
uart.port.iobase = 0;
|
|
uart.port.mapbase = baseaddr + offset;
|
|
uart.port.membase = ioaddr + offset;
|
|
uart.port.regshift = 0;
|
|
|
|
dev_dbg(&pdev->dev, "Setup PCI port: port %lx, irq %d, type %d\n",
|
|
uart.port.iobase, uart.port.irq, uart.port.iotype);
|
|
|
|
brd->line[i] = serial8250_register_8250_port(&uart);
|
|
if (brd->line[i] < 0) {
|
|
dev_err(&pdev->dev,
|
|
"Couldn't register serial port %lx, irq %d, type %d, error %d\n",
|
|
uart.port.iobase, uart.port.irq,
|
|
uart.port.iotype, brd->line[i]);
|
|
break;
|
|
}
|
|
}
|
|
|
|
pci_set_drvdata(pdev, brd);
|
|
return 0;
|
|
}
|
|
|
|
static void moxa8250_remove(struct pci_dev *pdev)
|
|
{
|
|
struct moxa8250_board *brd = pci_get_drvdata(pdev);
|
|
unsigned int i;
|
|
|
|
for (i = 0; i < brd->num_ports; i++)
|
|
serial8250_unregister_port(brd->line[i]);
|
|
}
|
|
|
|
#define MOXA_DEVICE(id, data) { PCI_VDEVICE(MOXA, id), (kernel_ulong_t)data }
|
|
|
|
static const struct pci_device_id pci_ids[] = {
|
|
MOXA_DEVICE(PCI_DEVICE_ID_MOXA_CP102E, moxa8250_2p),
|
|
MOXA_DEVICE(PCI_DEVICE_ID_MOXA_CP102EL, moxa8250_2p),
|
|
MOXA_DEVICE(PCI_DEVICE_ID_MOXA_CP104EL_A, moxa8250_4p),
|
|
MOXA_DEVICE(PCI_DEVICE_ID_MOXA_CP114EL, moxa8250_4p),
|
|
MOXA_DEVICE(PCI_DEVICE_ID_MOXA_CP116E_A_A, moxa8250_8p),
|
|
MOXA_DEVICE(PCI_DEVICE_ID_MOXA_CP116E_A_B, moxa8250_8p),
|
|
MOXA_DEVICE(PCI_DEVICE_ID_MOXA_CP118EL_A, moxa8250_8p),
|
|
MOXA_DEVICE(PCI_DEVICE_ID_MOXA_CP118E_A_I, moxa8250_8p),
|
|
MOXA_DEVICE(PCI_DEVICE_ID_MOXA_CP132EL, moxa8250_2p),
|
|
MOXA_DEVICE(PCI_DEVICE_ID_MOXA_CP134EL_A, moxa8250_4p),
|
|
MOXA_DEVICE(PCI_DEVICE_ID_MOXA_CP138E_A, moxa8250_8p),
|
|
MOXA_DEVICE(PCI_DEVICE_ID_MOXA_CP168EL_A, moxa8250_8p),
|
|
{0}
|
|
};
|
|
MODULE_DEVICE_TABLE(pci, pci_ids);
|
|
|
|
static struct pci_driver moxa8250_pci_driver = {
|
|
.name = "8250_moxa",
|
|
.id_table = pci_ids,
|
|
.probe = moxa8250_probe,
|
|
.remove = moxa8250_remove,
|
|
};
|
|
|
|
module_pci_driver(moxa8250_pci_driver);
|
|
|
|
MODULE_AUTHOR("Mathieu OTHACEHE");
|
|
MODULE_DESCRIPTION("MOXA SmartIO MUE driver");
|
|
MODULE_LICENSE("GPL v2");
|