X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/4ddb8468e0688f83f24fc041cfb62512ee45194a..4cf24de229090b1ab6279570a564d224e13dd706:/lincan/src/pccan.c diff --git a/lincan/src/pccan.c b/lincan/src/pccan.c new file mode 100644 index 0000000..bf5a8a8 --- /dev/null +++ b/lincan/src/pccan.c @@ -0,0 +1,441 @@ +/* pccan.c + * Linux CAN-bus device driver. + * Written by Arnaud Westenberg email:arnaud@wanadoo.nl + * This software is released under the GPL-License. + * Version 0.7 6 Aug 2001 + */ + +#include +#if defined (CONFIG_MODVERSIONS) && !defined (MODVERSIONS) +#define MODVERSIONS +#endif + +#if defined (MODVERSIONS) +#include +#endif + +#include +#include +#include +#include +#include + +#include "../include/main.h" +#include "../include/pccan.h" +#include "../include/i82527.h" +#include "../include/sja1000.h" + +int pccanf_request_io(unsigned long io_addr) +{ + if (check_region(io_addr+0x4000,0x20)) { + CANMSG("Unable to open port: 0x%lx\n",io_addr+0x4000); + return -ENODEV; + } + else if (check_region(io_addr+0x6000,0x04)) { + CANMSG("Unable to open port: 0x%lx\n",io_addr+0x6000); + return -ENODEV; + } + else { + request_region(io_addr+0x4000,0x20,DEVICE_NAME); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", io_addr+0x4000, io_addr+0x4000+0x20-1); + request_region(io_addr+0x6000,0x04,DEVICE_NAME); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", io_addr+0x6000, io_addr+0x6000+0x04-1); + } + return 0; +} + +int pccand_request_io(unsigned long io_addr) +{ + if (pccanf_request_io(io_addr)) + return -ENODEV; + + if (check_region(io_addr+0x5000,0x20)) { + CANMSG("Unable to open port: 0x%lx\n",io_addr+0x5000); + return -ENODEV; + } + else { + request_region(io_addr+0x5000,0x20,DEVICE_NAME); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", io_addr+0x5000, io_addr+0x5000+0x20-1); + } + return 0; +} + +int pccanq_request_io(unsigned long io_addr) +{ + if (pccand_request_io(io_addr)) + return -ENODEV; + + if (check_region(io_addr+0x2000,0x40)) { + CANMSG("Unable to open port: 0x%lx\n",io_addr+0x2000); + return -ENODEV; + } + else if (check_region(io_addr+0x2400,0x40)) { + CANMSG("Unable to open port: 0x%lx\n",io_addr+0x2400); + return -ENODEV; + } + else if (check_region(io_addr+0x2800,0x40)) { + CANMSG("Unable to open port: 0x%lx\n",io_addr+0x2800); + return -ENODEV; + } + else if (check_region(io_addr+0x2C00,0x40)) { + CANMSG("Unable to open port: 0x%lx\n",io_addr+0x2C00); + return -ENODEV; + } + else if (check_region(io_addr+0x3000,0x40)) { + CANMSG("Unable to open port: 0x%lx\n",io_addr+0x3000); + return -ENODEV; + } + else if (check_region(io_addr+0x3400,0x40)) { + CANMSG("Unable to open port: 0x%lx\n",io_addr+0x3400); + return -ENODEV; + } + else if (check_region(io_addr+0x3800,0x40)) { + CANMSG("Unable to open port: 0x%lx\n",io_addr+0x3800); + return -ENODEV; + } + else if (check_region(io_addr+0x3C00,0x40)) { + CANMSG("Unable to open port: 0x%lx\n",io_addr+0x3C00); + return -ENODEV; + } + else { + request_region(io_addr+0x2000,0x40,DEVICE_NAME); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", io_addr+0x2000, io_addr+0x2000+0x40-1); + request_region(io_addr+0x2400,0x40,DEVICE_NAME); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", io_addr+0x2400, io_addr+0x2400+0x40-1); + request_region(io_addr+0x2800,0x40,DEVICE_NAME); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", io_addr+0x2800, io_addr+0x2800+0x40-1); + request_region(io_addr+0x2C00,0x40,DEVICE_NAME); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", io_addr+0x2C00, io_addr+0x2C00+0x40-1); + request_region(io_addr+0x3000,0x40,DEVICE_NAME); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", io_addr+0x3000, io_addr+0x3000+0x40-1); + request_region(io_addr+0x3400,0x40,DEVICE_NAME); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", io_addr+0x3400, io_addr+0x3400+0x40-1); + request_region(io_addr+0x3800,0x40,DEVICE_NAME); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", io_addr+0x3800, io_addr+0x3800+0x40-1); + request_region(io_addr+0x3C00,0x40,DEVICE_NAME); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", io_addr+0x3C00, io_addr+0x3C00+0x40-1); + } + + return 0; +} + +int pccanf_release_io(unsigned long io_addr) +{ + release_region(io_addr+0x4000,0x20); + release_region(io_addr+0x6000,0x04); + + return 0; +} + +int pccand_release_io(unsigned long io_addr) +{ + pccanf_release_io(io_addr); + release_region(io_addr+0x5000,0x20); + + return 0; +} + +int pccanq_release_io(unsigned long io_addr) +{ + pccand_release_io(io_addr); + release_region(io_addr+0x2000,0x40); + release_region(io_addr+0x2400,0x40); + release_region(io_addr+0x2800,0x40); + release_region(io_addr+0x2C00,0x40); + release_region(io_addr+0x3000,0x40); + release_region(io_addr+0x3400,0x40); + release_region(io_addr+0x3800,0x40); + release_region(io_addr+0x3C00,0x40); + + return 0; +} + +int pccanf_reset(int card) +{ + int i=0; + + DEBUGMSG("Resetting pccanf/s hardware ...\n"); + while (i < 1000000) { + i++; + outb(0x00,candevices_p[card]->res_addr); + } + outb(0x01,candevices_p[card]->res_addr); + outb(0x00,candevices_p[card]->chip[0]->chip_base_addr+SJACR); + + /* Check hardware reset status */ + i=0; + while ( (inb(candevices_p[card]->chip[0]->chip_base_addr+SJACR) & CR_RR) + && (i<=15) ) { + udelay(20000); + i++; + } + if (i>=15) { + CANMSG("Reset status timeout!\n"); + CANMSG("Please check your hardware.\n"); + return -ENODEV; + } + else + DEBUGMSG("Chip[0] reset status ok.\n"); + + return 0; +} + +int pccand_reset(int card) +{ + int i=0,chip_nr=0; + + DEBUGMSG("Resetting pccan-d hardware ...\n"); + while (i < 1000000) { + i++; + outb(0x00,candevices_p[card]->res_addr); + } + outb(0x01,candevices_p[card]->res_addr); + outb(0x00,candevices_p[card]->chip[0]->chip_base_addr+SJACR); + outb(0x00,candevices_p[card]->chip[1]->chip_base_addr+SJACR); + + /* Check hardware reset status */ + i=0; + for (chip_nr=0; chip_nr<2; chip_nr++) { + i=0; + while ( (inb(candevices_p[card]->chip[chip_nr]->chip_base_addr + + SJACR) & CR_RR) && (i<=15) ) { + udelay(20000); + i++; + } + if (i>=15) { + CANMSG("Reset status timeout!\n"); + CANMSG("Please check your hardware.\n"); + return -ENODEV; + } + else + DEBUGMSG("Chip%d reset status ok.\n",chip_nr); + } + return 0; +} + +int pccanq_reset(int card) +{ + int i=0,chip_nr=0; + + for (i=0; i<4; i++) + disable_irq(candevices_p[card]->chip[i]->chip_irq); + + DEBUGMSG("Resetting pccan-q hardware ...\n"); + while (i < 100000) { + i++; + outb(0x00,candevices_p[card]->res_addr); + } + outb_p(0x01,candevices_p[card]->res_addr); + + outb(0x00,candevices_p[card]->chip[2]->chip_base_addr+SJACR); + outb(0x00,candevices_p[card]->chip[3]->chip_base_addr+SJACR); + + /* Check hardware reset status */ + for (chip_nr=0; chip_nr<2; chip_nr++) { + i=0; + while( (inb(candevices_p[card]->chip[chip_nr]->chip_base_addr + + iCPU) & iCPU_RST) && (i<=15) ) { + udelay(20000); + i++; + } + if (i>=15) { + CANMSG("Reset status timeout!\n"); + CANMSG("Please check your hardware.\n"); + return -ENODEV; + } + else + DEBUGMSG("Chip%d reset status ok.\n",chip_nr); + } + for (chip_nr=2; chip_nr<4; chip_nr++) { + i=0; + while( (inb(candevices_p[card]->chip[chip_nr]->chip_base_addr + + SJACR) & CR_RR) && (i<=15) ) { + udelay(20000); + i++; + } + if (i>=15) { + CANMSG("Reset status timeout!\n"); + CANMSG("Please check your hardware.\n"); + return -ENODEV; + } + else + DEBUGMSG("Chip%d reset status ok.\n",chip_nr); + } + + for (i=0; i<4; i++) + enable_irq(candevices_p[card]->chip[i]->chip_irq); + + return 0; +} + +int pccan_init_hw_data(int card) +{ + candevices_p[card]->res_addr=candevices_p[card]->io_addr+0x6001; + candevices_p[card]->flags |= PROGRAMMABLE_IRQ; + + if (!strcmp(candevices_p[card]->hwname,"pccan-q")) { + candevices_p[card]->nr_82527_chips=2; + candevices_p[card]->nr_sja1000_chips=2; + } + if (!strcmp(candevices_p[card]->hwname,"pccan-f") | + !strcmp(candevices_p[card]->hwname,"pccan-s")) { + candevices_p[card]->nr_82527_chips=0; + candevices_p[card]->nr_sja1000_chips=1; + } + if (!strcmp(candevices_p[card]->hwname,"pccan-d")) { + candevices_p[card]->nr_82527_chips=0; + candevices_p[card]->nr_sja1000_chips=2; + } + + return 0; +} + +int pccan_init_chip_data(int card, int chipnr) +{ + if (!strcmp(candevices_p[card]->hwname,"pccan-q")) { + if (chipnr<2) { + candevices_p[card]->chip[chipnr]->chip_type="i82527"; + candevices_p[card]->chip[chipnr]->flags = SEGMENTED; + candevices_p[card]->chip[chipnr]->int_cpu_reg=iCPU_DSC; + 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; + } + else{ + candevices_p[card]->chip[chipnr]->chip_type="sja1000"; + candevices_p[card]->chip[chipnr]->flags = 0; + candevices_p[card]->chip[chipnr]->int_cpu_reg = 0; + candevices_p[card]->chip[chipnr]->int_clk_reg = 0; + candevices_p[card]->chip[chipnr]->int_bus_reg = 0; + candevices_p[card]->chip[chipnr]->sja_cdr_reg = + CDR_CLK_OFF; + candevices_p[card]->chip[chipnr]->sja_ocr_reg = + OCR_MODE_NORMAL | OCR_TX0_LH; + } + candevices_p[card]->chip[chipnr]->chip_base_addr=0x1000*chipnr+0x2000+candevices_p[card]->io_addr; + } + else { + candevices_p[card]->chip[chipnr]->chip_type="sja1000"; + candevices_p[card]->chip[chipnr]->chip_base_addr=0x1000*chipnr+0x4000+candevices_p[card]->io_addr; + candevices_p[card]->chip[chipnr]->flags = 0; + candevices_p[card]->chip[chipnr]->int_cpu_reg = 0; + candevices_p[card]->chip[chipnr]->int_clk_reg = 0; + candevices_p[card]->chip[chipnr]->int_bus_reg = 0; + candevices_p[card]->chip[chipnr]->sja_cdr_reg = CDR_CLK_OFF; + candevices_p[card]->chip[chipnr]->sja_ocr_reg = + OCR_MODE_NORMAL | OCR_TX0_LH; + } + + candevices_p[card]->chip[chipnr]->clock = 16000000; + + return 0; +} + +int pccan_init_obj_data(int chipnr, int objnr) +{ + if (!strcmp(chips_p[chipnr]->chip_type,"sja1000")) { + chips_p[chipnr]->msgobj[objnr]->obj_base_addr=chips_p[chipnr]->chip_base_addr; + chips_p[chipnr]->msgobj[objnr]->flags=0; + } + else { + chips_p[chipnr]->msgobj[objnr]->obj_base_addr=chips_p[chipnr]->chip_base_addr+(objnr+1)*0x10+(int)((objnr+1)/4)*0x3c0; + chips_p[chipnr]->msgobj[objnr]->flags=0; + } + + return 0; +} + +int pccan_program_irq(int card) +{ + #define IRQ9 0x01 + #define IRQ3 0x02 + #define IRQ5 0x03 + + unsigned char irq_reg_value=0; + int i; + + for (i=0; i<4; i++) { + switch (candevices_p[card]->chip[i]->chip_irq) { + case 0: { + break; + } + case 3: { + irq_reg_value |= (IRQ3<<(i*2)); + break; + } + case 5: { + irq_reg_value |= (IRQ5<<(i*2)); + break; + } + case 9: { + irq_reg_value |= (IRQ9<<(i*2)); + break; + } + default: { + CANMSG("Supplied interrupt is not supported by the hardware\n"); + return -ENODEV; + } + } + } + outb(irq_reg_value,0x6000+candevices_p[card]->io_addr); + DEBUGMSG("Configured pccan hardware interrupts\n"); + outb(0x80,0x6000+candevices_p[card]->io_addr+0x02); + DEBUGMSG("Selected pccan on-board 16 MHz oscillator\n"); + + return 0; +} + +inline void pccan_write_register(unsigned char data, unsigned long address) +{ + outb(data,address); +} + +unsigned pccan_read_register(unsigned long address) +{ + return inb(address); +} + +int pccanf_register(struct hwspecops_t *hwspecops) +{ + hwspecops->request_io = pccanf_request_io; + hwspecops->release_io = pccanf_release_io; + hwspecops->reset = pccanf_reset; + hwspecops->init_hw_data = pccan_init_hw_data; + hwspecops->init_chip_data = pccan_init_chip_data; + hwspecops->init_obj_data = pccan_init_obj_data; + hwspecops->write_register = pccan_write_register; + hwspecops->read_register = pccan_read_register; + hwspecops->program_irq = pccan_program_irq; + return 0; +} + + +int pccand_register(struct hwspecops_t *hwspecops) +{ + hwspecops->request_io = pccand_request_io; + hwspecops->release_io = pccand_release_io; + hwspecops->reset = pccand_reset; + hwspecops->init_hw_data = pccan_init_hw_data; + hwspecops->init_chip_data = pccan_init_chip_data; + hwspecops->init_obj_data = pccan_init_obj_data; + hwspecops->write_register = pccan_write_register; + hwspecops->read_register = pccan_read_register; + hwspecops->program_irq = pccan_program_irq; + return 0; +} + + +int pccanq_register(struct hwspecops_t *hwspecops) +{ + hwspecops->request_io = pccanq_request_io; + hwspecops->release_io = pccanq_release_io; + hwspecops->reset = pccanq_reset; + hwspecops->init_hw_data = pccan_init_hw_data; + hwspecops->init_chip_data = pccan_init_chip_data; + hwspecops->init_obj_data = pccan_init_obj_data; + hwspecops->write_register = pccan_write_register; + hwspecops->read_register = pccan_read_register; + hwspecops->program_irq = pccan_program_irq; + return 0; +}