X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/97078fff5202521b758c9081d75580880417a123..11132ea490f9e860744ee4f851c67e7fb4444231:/lincan/src/pip.c diff --git a/lincan/src/pip.c b/lincan/src/pip.c index 6bbfd8d..72ede89 100644 --- a/lincan/src/pip.c +++ b/lincan/src/pip.c @@ -1,18 +1,13 @@ /* pip.c * Linux CAN-bus device driver. * Written by Arnaud Westenberg email:arnaud@wanadoo.nl + * Rewritten for new CAN queues by Pavel Pisa - OCERA team member + * email:pisa@cmp.felk.cvut.cz * This software is released under the GPL-License. - * Version 0.7 6 Aug 2001 + * Version lincan-0.2 9 Jul 2003 */ #include -#if defined (CONFIG_MODVERSIONS) && !defined (MODVERSIONS) -#define MODVERSIONS -#endif - -#if defined (MODVERSIONS) -#include -#endif #include #include @@ -24,90 +19,88 @@ #include "../include/pip.h" #include "../include/i82527.h" -int pip5_request_io(unsigned long io_addr) +int pip5_request_io(struct candevice_t *candev) { - if (io_addr != 0x8000) { + if (candev->io_addr != 0x8000) { CANMSG("Invalid base io address\n"); CANMSG("The PIP5 uses a fixed base address of 0x8000,\n"); CANMSG("please consult your user manual.\n"); return -ENODEV; } - if (check_region(io_addr,0x100)) { - CANMSG("Unable to open port: 0x%lx\n",io_addr); + if (!can_request_io_region(candev->io_addr,0x100,DEVICE_NAME)) { + CANMSG("Unable to open port: 0x%lx\n",candev->io_addr); return -ENODEV; } - else if(check_region(io_addr+0x102,0x01)) { - CANMSG("Unable to open port: 0x%lx\n",io_addr+0x102); + else if(!can_request_io_region(candev->io_addr+0x102,0x01,DEVICE_NAME)) { + can_release_io_region(candev->io_addr,0x100); + CANMSG("Unable to open port: 0x%lx\n",candev->io_addr+0x102); return -ENODEV; } else { - request_region(io_addr,0x100,DEVICE_NAME); - DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", io_addr, io_addr + 0x100 - 1); - request_region(io_addr+0x102,0x01,DEVICE_NAME); - DEBUGMSG("Registered IO-memory: 0x%lx\n", io_addr+0x102); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", candev->io_addr, candev->io_addr + 0x100 - 1); + DEBUGMSG("Registered IO-memory: 0x%lx\n", candev->io_addr+0x102); } return 0; } -int pip6_request_io(unsigned long io_addr) +int pip6_request_io(struct candevice_t *candev) { - if ( (io_addr != 0x1000)&&(io_addr != 0x8000)&&(io_addr != 0xe000)) { + if ( (candev->io_addr != 0x1000)&&(candev->io_addr != 0x8000)&&(candev->io_addr != 0xe000)) { CANMSG("Invalid base io address\n"); CANMSG("Valid values for the PIP6 are: 0x1000, 0x8000 or 0xe000\n"); CANMSG("Please consult your user manual.\n"); return -ENODEV; } - if (check_region(io_addr,0x100)) { - CANMSG("Unable to open port: 0x%lx\n",io_addr); + if (!can_request_io_region(candev->io_addr,0x100, DEVICE_NAME)) { + CANMSG("Unable to open port: 0x%lx\n",candev->io_addr); return -ENODEV; } - else if (check_region(0x804, 0x02)) { + else if (!can_request_io_region(0x804,0x02,DEVICE_NAME)) { + can_release_io_region(candev->io_addr,0x100); CANMSG("Unable to open port: 0x%x\n", 0x804); return -ENODEV; } else { - request_region(io_addr,0x100, DEVICE_NAME); - DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", io_addr, io_addr + 0x100 -1); - request_region(0x804,0x02,DEVICE_NAME); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", candev->io_addr, candev->io_addr + 0x100 -1); DEBUGMSG("Registered IO-memory : 0x%x - 0x%x\n",0x804,0x805); } return 0; } -int pip5_release_io(unsigned long io_addr) +int pip5_release_io(struct candevice_t *candev) { - release_region(io_addr,0x100); - release_region(io_addr+0x102,0x01); + can_release_io_region(candev->io_addr,0x100); + can_release_io_region(candev->io_addr+0x102,0x01); return 0; } -int pip6_release_io(unsigned long io_addr) +int pip6_release_io(struct candevice_t *candev) { - release_region(io_addr,0x100); - release_region(0x804,0x02); + can_release_io_region(candev->io_addr,0x100); + can_release_io_region(0x804,0x02); return 0; } -int pip_reset(int card) +int pip_reset(struct candevice_t *candev) { int i=0, res_value=0; - DEBUGMSG("Resetting %s hardware ...\n", candevices_p[card]->hwname); - if (!strcmp(candevices_p[card]->hwname,"pip5")) + DEBUGMSG("Resetting %s hardware ...\n", candev->hwname); + if (!strcmp(candev->hwname,"pip5")) res_value = 0xcf; else res_value = 0x01; while (i < 1000000) { i++; - outb(res_value,candevices_p[card]->res_addr); + outb(res_value,candev->res_addr); } - outb(0x0,candevices_p[card]->res_addr); + outb(0x0,candev->res_addr); /* Check hardware reset status */ i=0; - while ( (inb(candevices_p[card]->io_addr+iCPU) & iCPU_RST) && (i<=15)) { + while ( (inb(candev->io_addr+iCPU) & iCPU_RST) && (i<=15)) { udelay(20000); i++; } @@ -123,70 +116,71 @@ int pip_reset(int card) return 0; } -int pip_init_hw_data(int card) +int pip_init_hw_data(struct candevice_t *candev) { - if (!strcmp(candevices_p[card]->hwname,"pip5")) - candevices_p[card]->res_addr=candevices_p[card]->io_addr+0x102; + if (!strcmp(candev->hwname,"pip5")) + candev->res_addr=candev->io_addr+0x102; else - candevices_p[card]->res_addr=0x805; - candevices_p[card]->nr_82527_chips=1; - candevices_p[card]->nr_sja1000_chips=0; - candevices_p[card]->flags |= PROGRAMMABLE_IRQ; + candev->res_addr=0x805; + candev->nr_82527_chips=1; + candev->nr_sja1000_chips=0; + candev->nr_all_chips=1; + candev->flags |= PROGRAMMABLE_IRQ; return 0; } -int pip_init_chip_data(int card, int chipnr) +int pip_init_chip_data(struct candevice_t *candev, int chipnr) { - candevices_p[card]->chip[chipnr]->chip_type="i82527"; - candevices_p[card]->chip[chipnr]->chip_base_addr=candevices_p[card]->io_addr; - candevices_p[card]->chip[chipnr]->clock = 16000000; - if (!strcmp(candevices_p[card]->hwname,"pip5")) - candevices_p[card]->chip[chipnr]->int_cpu_reg = iCPU_DSC; + candev->chip[chipnr]->chip_type="i82527"; + candev->chip[chipnr]->chip_base_addr=candev->io_addr; + candev->chip[chipnr]->clock = 16000000; + if (!strcmp(candev->hwname,"pip5")) + candev->chip[chipnr]->int_cpu_reg = iCPU_DSC; else - candevices_p[card]->chip[chipnr]->int_cpu_reg = 0x0; - candevices_p[card]->chip[chipnr]->int_clk_reg = iCLK_SL1; - candevices_p[card]->chip[chipnr]->int_bus_reg = iBUS_CBY; - candevices_p[card]->chip[chipnr]->sja_cdr_reg = 0; - candevices_p[card]->chip[chipnr]->sja_ocr_reg = 0; + candev->chip[chipnr]->int_cpu_reg = 0x0; + candev->chip[chipnr]->int_clk_reg = iCLK_SL1; + candev->chip[chipnr]->int_bus_reg = iBUS_CBY; + candev->chip[chipnr]->sja_cdr_reg = 0; + candev->chip[chipnr]->sja_ocr_reg = 0; return 0; } -int pip_init_obj_data(int chipnr, int objnr) +int pip_init_obj_data(struct chip_t *chip, int objnr) { - chips_p[chipnr]->msgobj[objnr]->obj_base_addr=chips_p[chipnr]->chip_base_addr+(objnr+1)*0x10; - chips_p[chipnr]->msgobj[objnr]->flags=0; + chip->msgobj[objnr]->obj_base_addr=chip->chip_base_addr+(objnr+1)*0x10; + chip->msgobj[objnr]->flags=0; return 0; } -int pip5_program_irq(int card) +int pip5_program_irq(struct candevice_t *candev) { - outb(0x01, candevices_p[card]->res_addr); - switch (candevices_p[card]->chip[0]->chip_irq) { - case 3: { outb(0x03, candevices_p[card]->res_addr); break; } - case 4: { outb(0x05, candevices_p[card]->res_addr); break; } - case 5: { outb(0x07, candevices_p[card]->res_addr); break; } - case 10: { outb(0x09, candevices_p[card]->res_addr); break; } - case 11: { outb(0x0c, candevices_p[card]->res_addr); break; } - case 15: { outb(0x0d, candevices_p[card]->res_addr); break; } + outb(0x01, candev->res_addr); + switch (candev->chip[0]->chip_irq) { + case 3: { outb(0x03, candev->res_addr); break; } + case 4: { outb(0x05, candev->res_addr); break; } + case 5: { outb(0x07, candev->res_addr); break; } + case 10: { outb(0x09, candev->res_addr); break; } + case 11: { outb(0x0c, candev->res_addr); break; } + case 15: { outb(0x0d, candev->res_addr); break; } default: { CANMSG("Supplied interrupt is not supported by the hardware\n"); CANMSG("Please consult your user manual.\n"); return -ENODEV; } } - outb(0x00, candevices_p[card]->res_addr); + outb(0x00, candev->res_addr); return 0; } -int pip6_program_irq(int card) +int pip6_program_irq(struct candevice_t *candev) { unsigned char can_int = 0, can_addr = 0; - can_int = candevices_p[card]->chip[0]->chip_irq; + can_int = candev->chip[0]->chip_irq; if ((can_int != 3) && (can_int != 4) && (can_int != 5) && (can_int != 6) && (can_int != 7) && (can_int != 9) && (can_int != 10) && (can_int != 11) && (can_int != 12) && (can_int != 14) && @@ -196,7 +190,7 @@ int pip6_program_irq(int card) CANMSG("Please consult your user manual.\n"); return -ENODEV; } - switch (candevices_p[card]->io_addr) { + switch (candev->io_addr) { case 0x1000: { can_addr = 0x01; break; } case 0x8000: { can_addr = 0x02; break; } case 0xe000: { can_addr = 0x03; break; }