X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/4cf24de229090b1ab6279570a564d224e13dd706..04ac67cc3cac14cd601daacd0592121ec0b84012:/lincan/src/pccan.c diff --git a/lincan/src/pccan.c b/lincan/src/pccan.c index bf5a8a8..7086151 100644 --- a/lincan/src/pccan.c +++ b/lincan/src/pccan.c @@ -1,170 +1,146 @@ -/* 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 - +/**************************************************************************/ +/* File: pccan.c - PCcan-Q/F/S/D ISA card by KVASER */ +/* */ +/* LinCAN - (Not only) Linux CAN bus driver */ +/* Copyright (C) 2002-2009 DCE FEE CTU Prague */ +/* Copyright (C) 2002-2009 Pavel Pisa */ +/* Funded by OCERA and FRESCOR IST projects */ +/* Based on CAN driver code by Arnaud Westenberg */ +/* */ +/* LinCAN is free software; you can redistribute it and/or modify it */ +/* under terms of the GNU General Public License as published by the */ +/* Free Software Foundation; either version 2, or (at your option) any */ +/* later version. LinCAN is distributed in the hope that it will be */ +/* useful, but WITHOUT ANY WARRANTY; without even the implied warranty */ +/* of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU */ +/* General Public License for more details. You should have received a */ +/* copy of the GNU General Public License along with LinCAN; see file */ +/* COPYING. If not, write to the Free Software Foundation, 675 Mass Ave, */ +/* Cambridge, MA 02139, USA. */ +/* */ +/* To allow use of LinCAN in the compact embedded systems firmware */ +/* and RT-executives (RTEMS for example), main authors agree with next */ +/* special exception: */ +/* */ +/* Including LinCAN header files in a file, instantiating LinCAN generics */ +/* or templates, or linking other files with LinCAN objects to produce */ +/* an application image/executable, does not by itself cause the */ +/* resulting application image/executable to be covered by */ +/* the GNU General Public License. */ +/* This exception does not however invalidate any other reasons */ +/* why the executable file might be covered by the GNU Public License. */ +/* Publication of enhanced or derived LinCAN files is required although. */ +/**************************************************************************/ + +#include "../include/can.h" +#include "../include/can_sysdep.h" #include "../include/main.h" #include "../include/pccan.h" #include "../include/i82527.h" #include "../include/sja1000.h" -int pccanf_request_io(unsigned long io_addr) +int pccanf_request_io(struct candevice_t *candev) { - if (check_region(io_addr+0x4000,0x20)) { - CANMSG("Unable to open port: 0x%lx\n",io_addr+0x4000); + if (!can_request_io_region(candev->io_addr+0x4000,0x20,DEVICE_NAME)) { + CANMSG("Unable to open port: 0x%lx\n",candev->io_addr+0x4000); return -ENODEV; } - else if (check_region(io_addr+0x6000,0x04)) { - CANMSG("Unable to open port: 0x%lx\n",io_addr+0x6000); + else if (!can_request_io_region(candev->io_addr+0x6000,0x04,DEVICE_NAME)) { + can_release_io_region(candev->io_addr+0x4000,0x20); + CANMSG("Unable to open port: 0x%lx\n",candev->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); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", candev->io_addr+0x4000, candev->io_addr+0x4000+0x20-1); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", candev->io_addr+0x6000, candev->io_addr+0x6000+0x04-1); } return 0; } -int pccand_request_io(unsigned long io_addr) +int pccand_request_io(struct candevice_t *candev) { - if (pccanf_request_io(io_addr)) + if (pccanf_request_io(candev)) return -ENODEV; - if (check_region(io_addr+0x5000,0x20)) { - CANMSG("Unable to open port: 0x%lx\n",io_addr+0x5000); + if (!can_request_io_region(candev->io_addr+0x5000,0x20,DEVICE_NAME)) { + pccanf_release_io(candev); + CANMSG("Unable to open port: 0x%lx\n",candev->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); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", candev->io_addr+0x5000, candev->io_addr+0x5000+0x20-1); } return 0; } -int pccanq_request_io(unsigned long io_addr) +int pccanq_request_io(struct candevice_t *candev) { - if (pccand_request_io(io_addr)) - return -ENODEV; + unsigned long io_addr; + int i; - 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); + if (pccand_request_io(candev)) 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); - } + for(i=0, io_addr=candev->io_addr+0x2000; i<8; i++, io_addr+=0x400) { + if (!can_request_io_region(io_addr,0x40,DEVICE_NAME)) { + CANMSG("Unable to open port: 0x%lx\n",io_addr); + while(i--){ + io_addr-=0x400; + can_release_io_region(io_addr,0x40); + } + pccand_release_io(candev); + return -ENODEV; + } + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", io_addr, io_addr+0x40-1); + } return 0; } -int pccanf_release_io(unsigned long io_addr) +int pccanf_release_io(struct candevice_t *candev) { - release_region(io_addr+0x4000,0x20); - release_region(io_addr+0x6000,0x04); + can_release_io_region(candev->io_addr+0x4000,0x20); + can_release_io_region(candev->io_addr+0x6000,0x04); return 0; } -int pccand_release_io(unsigned long io_addr) +int pccand_release_io(struct candevice_t *candev) { - pccanf_release_io(io_addr); - release_region(io_addr+0x5000,0x20); + pccanf_release_io(candev); + can_release_io_region(candev->io_addr+0x5000,0x20); return 0; } -int pccanq_release_io(unsigned long io_addr) +int pccanq_release_io(struct candevice_t *candev) { - 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); + unsigned long io_addr; + int i; + + pccand_release_io(candev); + + for(i=0, io_addr=candev->io_addr+0x2000; i<8; i++, io_addr+=0x400) { + can_release_io_region(io_addr,0x40); + } return 0; } -int pccanf_reset(int card) +int pccanf_reset(struct candevice_t *candev) { int i=0; DEBUGMSG("Resetting pccanf/s hardware ...\n"); while (i < 1000000) { i++; - outb(0x00,candevices_p[card]->res_addr); + can_outb(0x00,candev->res_addr); } - outb(0x01,candevices_p[card]->res_addr); - outb(0x00,candevices_p[card]->chip[0]->chip_base_addr+SJACR); + can_outb(0x01,candev->res_addr); + can_outb(0x00,candev->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) + while ( (can_inb(candev->chip[0]->chip_base_addr+SJACR) & sjaCR_RR) && (i<=15) ) { udelay(20000); i++; @@ -180,25 +156,25 @@ int pccanf_reset(int card) return 0; } -int pccand_reset(int card) +int pccand_reset(struct candevice_t *candev) { int i=0,chip_nr=0; DEBUGMSG("Resetting pccan-d hardware ...\n"); while (i < 1000000) { i++; - outb(0x00,candevices_p[card]->res_addr); + can_outb(0x00,candev->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); + can_outb(0x01,candev->res_addr); + can_outb(0x00,candev->chip[0]->chip_base_addr+SJACR); + can_outb(0x00,candev->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) ) { + while ( (can_inb(candev->chip[chip_nr]->chip_base_addr + + SJACR) & sjaCR_RR) && (i<=15) ) { udelay(20000); i++; } @@ -213,27 +189,27 @@ int pccand_reset(int card) return 0; } -int pccanq_reset(int card) +int pccanq_reset(struct candevice_t *candev) { int i=0,chip_nr=0; for (i=0; i<4; i++) - disable_irq(candevices_p[card]->chip[i]->chip_irq); + can_disable_irq(candev->chip[i]->chip_irq); DEBUGMSG("Resetting pccan-q hardware ...\n"); while (i < 100000) { i++; - outb(0x00,candevices_p[card]->res_addr); + can_outb(0x00,candev->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); + outb_p(0x01,candev->res_addr); + + can_outb(0x00,candev->chip[2]->chip_base_addr+SJACR); + can_outb(0x00,candev->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 + + while( (can_inb(candev->chip[chip_nr]->chip_base_addr + iCPU) & iCPU_RST) && (i<=15) ) { udelay(20000); i++; @@ -243,13 +219,13 @@ int pccanq_reset(int card) CANMSG("Please check your hardware.\n"); return -ENODEV; } - else + 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) ) { + while( (can_inb(candev->chip[chip_nr]->chip_base_addr + + SJACR) & sjaCR_RR) && (i<=15) ) { udelay(20000); i++; } @@ -263,90 +239,91 @@ int pccanq_reset(int card) } for (i=0; i<4; i++) - enable_irq(candevices_p[card]->chip[i]->chip_irq); + can_enable_irq(candev->chip[i]->chip_irq); return 0; -} +} -int pccan_init_hw_data(int card) +int pccan_init_hw_data(struct candevice_t *candev) { - candevices_p[card]->res_addr=candevices_p[card]->io_addr+0x6001; - candevices_p[card]->flags |= PROGRAMMABLE_IRQ; + candev->res_addr=candev->io_addr+0x6001; + candev->flags |= CANDEV_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(candev->hwname,"pccan-q")) { + candev->nr_82527_chips=2; + candev->nr_sja1000_chips=2; + candev->nr_all_chips=4; } - 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(candev->hwname,"pccan-f") | + !strcmp(candev->hwname,"pccan-s")) { + candev->nr_82527_chips=0; + candev->nr_sja1000_chips=1; + candev->nr_all_chips=1; } - if (!strcmp(candevices_p[card]->hwname,"pccan-d")) { - candevices_p[card]->nr_82527_chips=0; - candevices_p[card]->nr_sja1000_chips=2; + if (!strcmp(candev->hwname,"pccan-d")) { + candev->nr_82527_chips=0; + candev->nr_sja1000_chips=2; + candev->nr_all_chips=2; } return 0; } -int pccan_init_chip_data(int card, int chipnr) +int pccan_init_chip_data(struct candevice_t *candev, int chipnr) { - if (!strcmp(candevices_p[card]->hwname,"pccan-q")) { + if (!strcmp(candev->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; + i82527_fill_chipspecops(candev->chip[chipnr]); + candev->chip[chipnr]->flags = CHIP_SEGMENTED; + candev->chip[chipnr]->int_cpu_reg=iCPU_DSC; + 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; } 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; + sja1000_fill_chipspecops(candev->chip[chipnr]); + candev->chip[chipnr]->flags = 0; + candev->chip[chipnr]->int_cpu_reg = 0; + candev->chip[chipnr]->int_clk_reg = 0; + candev->chip[chipnr]->int_bus_reg = 0; + candev->chip[chipnr]->sja_cdr_reg = + sjaCDR_CLK_OFF; + candev->chip[chipnr]->sja_ocr_reg = + sjaOCR_MODE_NORMAL | sjaOCR_TX0_LH; } - candevices_p[card]->chip[chipnr]->chip_base_addr=0x1000*chipnr+0x2000+candevices_p[card]->io_addr; + candev->chip[chipnr]->chip_base_addr=can_ioport2ioptr(0x1000*chipnr+0x2000+candev->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; + sja1000_fill_chipspecops(candev->chip[chipnr]); + candev->chip[chipnr]->chip_base_addr=can_ioport2ioptr(0x1000*chipnr+0x4000+candev->io_addr); + candev->chip[chipnr]->flags = 0; + candev->chip[chipnr]->int_cpu_reg = 0; + candev->chip[chipnr]->int_clk_reg = 0; + candev->chip[chipnr]->int_bus_reg = 0; + candev->chip[chipnr]->sja_cdr_reg = sjaCDR_CLK_OFF; + candev->chip[chipnr]->sja_ocr_reg = + sjaOCR_MODE_NORMAL | sjaOCR_TX0_LH; } - candevices_p[card]->chip[chipnr]->clock = 16000000; + candev->chip[chipnr]->clock = 16000000; return 0; -} +} -int pccan_init_obj_data(int chipnr, int objnr) +int pccan_init_obj_data(struct canchip_t *chip, 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; - } + if (!strcmp(chip->chip_type,"sja1000")) { + chip->msgobj[objnr]->obj_base_addr=chip->chip_base_addr; + } + else { /* The spacing for this card is 0x3c0 */ + chip->msgobj[objnr]->obj_base_addr=chip->chip_base_addr+(objnr+1)*0x10+(int)((objnr+1)/4)*0x3c0; + } return 0; } -int pccan_program_irq(int card) +int pccan_program_irq(struct candevice_t *candev) { #define IRQ9 0x01 #define IRQ3 0x02 @@ -356,7 +333,7 @@ int pccan_program_irq(int card) int i; for (i=0; i<4; i++) { - switch (candevices_p[card]->chip[i]->chip_irq) { + switch (candev->chip[i]->chip_irq) { case 0: { break; } @@ -378,22 +355,22 @@ int pccan_program_irq(int card) } } } - outb(irq_reg_value,0x6000+candevices_p[card]->io_addr); + can_outb(irq_reg_value,0x6000+candev->io_addr); DEBUGMSG("Configured pccan hardware interrupts\n"); - outb(0x80,0x6000+candevices_p[card]->io_addr+0x02); + can_outb(0x80,0x6000+candev->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) +inline void pccan_write_register(unsigned data, can_ioptr_t address) { - outb(data,address); + can_outb(data,address); } -unsigned pccan_read_register(unsigned long address) +unsigned pccan_read_register(can_ioptr_t address) { - return inb(address); + return can_inb(address); } int pccanf_register(struct hwspecops_t *hwspecops)