X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/92b76dca553a98a228f368f8ff6eedc25e33b870..af6f1816764635c4d495177b74fe89a9a0e5ac4f:/lincan/src/unican.c diff --git a/lincan/src/unican.c b/lincan/src/unican.c index efc5ac2..55cfbd5 100644 --- a/lincan/src/unican.c +++ b/lincan/src/unican.c @@ -3,7 +3,7 @@ * Written for new CAN driver version by Pavel Pisa - OCERA team member * email:pisa@cmp.felk.cvut.cz * This software is released under the GPL-License. - * Version lincan-0.2 9 Jul 2003 + * Version lincan-0.3 17 Jun 2004 */ #include "../include/can.h" @@ -12,10 +12,8 @@ #include "../include/unican_cl2.h" #include "../include/setup.h" -#ifdef CAN_WITH_RTL - -#endif /*CAN_WITH_RTL*/ - +#define UNICAN_PCI_VENDOR 0xFA3C +#define UNICAN_PCI_ID 0x0101 static void unican_delay(long msdelay) { @@ -31,26 +29,14 @@ static void unican_delay(long msdelay) } - -long unican_bus_latency(struct msgobj_t *obj) -{ - long latency; - latency=obj->hostchip->baudrate; - if(latency){ - latency=(long)HZ*1000/latency; - } - return latency; -} - - /* * * unican Chip Functionality * * */ -int unican_enable_configuration(struct chip_t *chip) +int unican_enable_configuration(struct canchip_t *chip) { return 0; } -int unican_disable_configuration(struct chip_t *chip) +int unican_disable_configuration(struct canchip_t *chip) { return 0; } @@ -62,7 +48,7 @@ int unican_disable_configuration(struct chip_t *chip) * Return Value: negative value reports error. * File: src/unican.c */ -int unican_chip_config(struct chip_t *chip) +int unican_chip_config(struct canchip_t *chip) { int ret; sCAN_CARD *chipext = (sCAN_CARD *)chip->chip_data; @@ -127,7 +113,7 @@ int unican_chip_config(struct chip_t *chip) * Return Value: negative value reports error. * File: src/unican.c */ -int unican_extended_mask(struct chip_t *chip, unsigned long code, unsigned long mask) +int unican_extended_mask(struct canchip_t *chip, unsigned long code, unsigned long mask) { return 0; } @@ -144,7 +130,7 @@ int unican_extended_mask(struct chip_t *chip, unsigned long code, unsigned long * Return Value: negative value reports error. * File: src/unican.c */ -int unican_baud_rate(struct chip_t *chip, int rate, int clock, int sjw, +int unican_baud_rate(struct canchip_t *chip, int rate, int clock, int sjw, int sampl_pt, int flags) { int ret; @@ -186,7 +172,7 @@ int unican_baud_rate(struct chip_t *chip, int rate, int clock, int sjw, * * File: src/unican.c */ -void unican_read(struct chip_t *chip, struct msgobj_t *obj) { +void unican_read(struct canchip_t *chip, struct msgobj_t *obj) { sCAN_CARD *chipext = (sCAN_CARD *)chip->chip_data; __u16 *ptr16; __u16 u; @@ -195,14 +181,14 @@ void unican_read(struct chip_t *chip, struct msgobj_t *obj) { do { ptr16 = (__u16*)chipext->rxBufPtr; - u = readw(ptr16++); + u = unican_readw(ptr16++); if ( !(u & CL2_MESSAGE_VALID) ) break; /* No more messages in the queue */ obj->rx_msg.id = ((__u32)(u & 0xFF00 )) << 16; - u = readw(ptr16++); + u = unican_readw(ptr16++); obj->rx_msg.id |= ((__u32)( u & 0x00FF )) << 16; obj->rx_msg.id |= (__u32)( u & 0xFF00 ); - u = readw(ptr16++); + u = unican_readw(ptr16++); obj->rx_msg.id |= (__u32)( u & 0x00FF ); @@ -223,17 +209,17 @@ void unican_read(struct chip_t *chip, struct msgobj_t *obj) { if(obj->rx_msg.length > CAN_MSG_LENGTH) obj->rx_msg.length = CAN_MSG_LENGTH; for ( i = 0; i < obj->rx_msg.length; ) { - u = readw(ptr16++); + u = unican_readw(ptr16++); obj->rx_msg.data[i++] = (__u8)( u ); obj->rx_msg.data[i++] = (__u8)( u >> 8 ); } if ( obj->rx_msg.length & 0x01 ) { /* odd */ - timestamp = ( (readw(ptr16++) & 0x00FF) | (u & 0xFF00) ); + timestamp = ( (unican_readw(ptr16++) & 0x00FF) | (u & 0xFF00) ); } else { /* even */ - u = readw(ptr16++); + u = unican_readw(ptr16++); timestamp = (u << 8) | (u >> 8); } - writew(0x000,(__u16*)chipext->rxBufPtr); + unican_writew(0x000,(__u16*)chipext->rxBufPtr); #ifdef CAN_MSG_VERSION_2 obj->rx_msg.timestamp.tv_sec = 0; @@ -261,7 +247,7 @@ void unican_read(struct chip_t *chip, struct msgobj_t *obj) { * Positive value indicates immediate reception of message. * File: src/unican.c */ -int unican_pre_read_config(struct chip_t *chip, struct msgobj_t *obj) +int unican_pre_read_config(struct canchip_t *chip, struct msgobj_t *obj) { return 0; } @@ -276,7 +262,7 @@ int unican_pre_read_config(struct chip_t *chip, struct msgobj_t *obj) * Return Value: negative value reports error. * File: src/unican.c */ -int unican_pre_write_config(struct chip_t *chip, struct msgobj_t *obj, +int unican_pre_write_config(struct canchip_t *chip, struct msgobj_t *obj, struct canmsg_t *msg) { return 0; @@ -293,7 +279,7 @@ int unican_pre_write_config(struct chip_t *chip, struct msgobj_t *obj, * Return Value: negative value reports error. * File: src/unican.c */ -int unican_send_msg(struct chip_t *chip, struct msgobj_t *obj, +int unican_send_msg(struct canchip_t *chip, struct msgobj_t *obj, struct canmsg_t *msg) { return 0; @@ -308,7 +294,7 @@ int unican_send_msg(struct chip_t *chip, struct msgobj_t *obj, * Zero value indicates finishing of all issued transmission requests. * File: src/unican.c */ -int unican_check_tx_stat(struct chip_t *chip) +int unican_check_tx_stat(struct canchip_t *chip) { return 0; } @@ -322,7 +308,7 @@ int unican_check_tx_stat(struct chip_t *chip) * Return Value: negative value reports error. * File: src/unican.c */ -int unican_set_btregs(struct chip_t *chip, unsigned short btr0, +int unican_set_btregs(struct canchip_t *chip, unsigned short btr0, unsigned short btr1) { int ret; @@ -344,7 +330,7 @@ int unican_set_btregs(struct chip_t *chip, unsigned short btr0, * Return Value: negative value reports error. * File: src/unican.c */ -int unican_start_chip(struct chip_t *chip) +int unican_start_chip(struct canchip_t *chip) { return 0; } @@ -356,11 +342,39 @@ int unican_start_chip(struct chip_t *chip) * Return Value: negative value reports error. * File: src/unican.c */ -int unican_stop_chip(struct chip_t *chip) +int unican_stop_chip(struct canchip_t *chip) { return 0; } +/** + * unican_attach_to_chip: - attaches to the chip, setups registers and state + * @chip: pointer to chip state structure + * + * Return Value: negative value reports error. + * File: src/sja1000p.c + */ +int unican_attach_to_chip(struct canchip_t *chip) +{ + return 0; +} + +/** + * unican_release_chip: - called before chip structure removal if %CHIP_ATTACHED is set + * @chip: pointer to chip state structure + * + * Return Value: negative value reports error. + * File: src/sja1000p.c + */ +int unican_release_chip(struct canchip_t *chip) +{ + sCAN_CARD *chipext = (sCAN_CARD *)chip->chip_data; + + unican_stop_chip(chip); + cl2_clear_interrupt(chipext); + + return 0; +} /** * unican_remote_request: - configures message object and asks for RTR message @@ -370,7 +384,7 @@ int unican_stop_chip(struct chip_t *chip) * Return Value: negative value reports error. * File: src/unican.c */ -int unican_remote_request(struct chip_t *chip, struct msgobj_t *obj) +int unican_remote_request(struct canchip_t *chip, struct msgobj_t *obj) { CANMSG("unican_remote_request not implemented\n"); return -ENOSYS; @@ -385,7 +399,7 @@ int unican_remote_request(struct chip_t *chip, struct msgobj_t *obj) * Return Value: negative value reports error. * File: src/unican.c */ -int unican_standard_mask(struct chip_t *chip, unsigned short code, +int unican_standard_mask(struct canchip_t *chip, unsigned short code, unsigned short mask) { CANMSG("unican_standard_mask not implemented\n"); @@ -399,7 +413,7 @@ int unican_standard_mask(struct chip_t *chip, unsigned short code, * Return Value: negative value reports error. * File: src/unican.c */ -int unican_clear_objects(struct chip_t *chip) +int unican_clear_objects(struct canchip_t *chip) { CANMSG("unican_clear_objects not implemented\n"); return -ENOSYS; @@ -413,7 +427,7 @@ int unican_clear_objects(struct chip_t *chip) * Return Value: negative value reports error. * File: src/unican.c */ -int unican_config_irqs(struct chip_t *chip, short irqs) +int unican_config_irqs(struct canchip_t *chip, short irqs) { CANMSG("unican_config_irqs not implemented\n"); @@ -431,7 +445,7 @@ int unican_config_irqs(struct chip_t *chip, short irqs) * unican_irq_write_handler() for transmit events. * File: src/unican.c */ -void unican_irq_write_handler(struct chip_t *chip, struct msgobj_t *obj) +void unican_irq_write_handler(struct canchip_t *chip, struct msgobj_t *obj) { int cmd; sCAN_CARD *chipext = (sCAN_CARD *)chip->chip_data; @@ -462,7 +476,7 @@ void unican_irq_write_handler(struct chip_t *chip, struct msgobj_t *obj) do { ptr16 = (__u16*)chipext->asyncTxBufPtr; - if(readw(ptr16) & CL2_MESSAGE_VALID) + if(unican_readw(ptr16) & CL2_MESSAGE_VALID) return; /* No free space in asynchronous Tx queue */ cmd=canque_test_outslot(obj->qends, &obj->tx_qedge, &obj->tx_slot); @@ -479,7 +493,7 @@ void unican_irq_write_handler(struct chip_t *chip, struct msgobj_t *obj) } ptr16++; u = ((cobid>>16) & 0x00FF ) + (cobid & 0xFF00); - writew(u,ptr16++); + unican_writew(u,ptr16++); len = obj->tx_slot->msg.length; if(len > CAN_MSG_LENGTH) @@ -491,24 +505,24 @@ void unican_irq_write_handler(struct chip_t *chip, struct msgobj_t *obj) if ( obj->tx_slot->msg.flags & MSG_EXT ) u |= CL2_EXT_FRAME<<8; - writew(u,ptr16++); + unican_writew(u,ptr16++); for ( i = 0; i < len-1; ) { u = obj->tx_slot->msg.data[i++]; u |= ((__u16)obj->tx_slot->msg.data[i]<<8); i++; - writew(u,ptr16++); + unican_writew(u,ptr16++); } if(i == len) { - writew(timestamp,ptr16); + unican_writew(timestamp,ptr16); } else { u = obj->tx_slot->msg.data[i++]; u |= ((timestamp & 0x00FF)<<8); - writew(u,ptr16++); - writew(timestamp & 0x00FF, ptr16); + unican_writew(u,ptr16++); + unican_writew(timestamp & 0x00FF, ptr16); } u = ((cobid>>16) & 0xFF00) | CL2_MESSAGE_VALID; - writew(u,(__u16*)chipext->asyncTxBufPtr); + unican_writew(u,(__u16*)chipext->asyncTxBufPtr); if ( (chipext->asyncTxBufBase + chipext->asyncTxBufSize*16) <= (chipext->asyncTxBufPtr += 16) ) { @@ -533,7 +547,7 @@ void unican_irq_write_handler(struct chip_t *chip, struct msgobj_t *obj) } -void unican_irq_sync_activities(struct chip_t *chip, struct msgobj_t *obj) +void unican_irq_sync_activities(struct canchip_t *chip, struct msgobj_t *obj) { while(!can_msgobj_test_and_set_fl(obj,TX_LOCK)) { @@ -560,10 +574,7 @@ void unican_irq_sync_activities(struct chip_t *chip, struct msgobj_t *obj) /** * unican_irq_handler: - interrupt service routine * @irq: interrupt vector number, this value is system specific - * @dev_id: driver private pointer registered at time of request_irq() call. - * The CAN driver uses this pointer to store relationship of interrupt - * to chip state structure - @struct chip_t - * @regs: system dependent value pointing to registers stored in exception frame + * @chip: pointer to chip state structure * * Interrupt handler is activated when state of CAN controller chip changes, * there is message to be read or there is more space for new messages or @@ -572,9 +583,8 @@ void unican_irq_sync_activities(struct chip_t *chip, struct msgobj_t *obj) * message queues. * File: src/unican.c */ -can_irqreturn_t unican_irq_handler(int irq, void *dev_id, struct pt_regs *regs) +int unican_irq_handler(int irq, struct canchip_t *chip) { - struct chip_t *chip=(struct chip_t *)dev_id; sCAN_CARD *chipext = (sCAN_CARD *)chip->chip_data; struct msgobj_t *obj=chip->msgobj[0]; __u16 status; @@ -582,11 +592,16 @@ can_irqreturn_t unican_irq_handler(int irq, void *dev_id, struct pt_regs *regs) if(!(chip->flags&CHIP_CONFIGURED)) { CANMSG("unican_irq_handler: called for non-configured device\n"); - return CAN_IRQ_NONE; + return CANCHIP_IRQ_NONE; } - if (cl2_get_status(chipext, &status) == CL2_NO_REQUEST) - return CAN_IRQ_NONE; + if (cl2_get_status(chipext, &status) == CL2_NO_REQUEST) { + /* Reenable interrupts generation, this has to be even there, + * because irq_accept disables interrupts + */ + cl2_gen_interrupt(chipext); + return CANCHIP_IRQ_NONE; + } cl2_clear_interrupt(chipext); @@ -609,12 +624,31 @@ can_irqreturn_t unican_irq_handler(int irq, void *dev_id, struct pt_regs *regs) unican_read(chip, obj); } + /* Reenable interrupts generation */ cl2_gen_interrupt(chipext); - return CAN_IRQ_HANDLED; + return CANCHIP_IRQ_HANDLED; } +/** + * unican_irq_accept: - fast irq accept routine, blocks further interrupts + * @irq: interrupt vector number, this value is system specific + * @chip: pointer to chip state structure + * + * This routine only accepts interrupt reception and stops further + * incoming interrupts, but does not handle situation causing interrupt. + * File: src/unican.c + */ +int unican_irq_accept(int irq, struct canchip_t *chip) +{ + sCAN_CARD *chipext = (sCAN_CARD *)chip->chip_data; + + cl2_clear_interrupt(chipext); + + return CANCHIP_IRQ_ACCEPTED; +} + /*void unican_do_tx_timeout(unsigned long data) { struct msgobj_t *obj=(struct msgobj_t *)data; @@ -629,7 +663,7 @@ can_irqreturn_t unican_irq_handler(int irq, void *dev_id, struct pt_regs *regs) * Return Value: negative value reports error. * File: src/unican.c */ -int unican_wakeup_tx(struct chip_t *chip, struct msgobj_t *obj) +int unican_wakeup_tx(struct canchip_t *chip, struct msgobj_t *obj) { can_preempt_disable(); @@ -700,7 +734,7 @@ int unican_reset(struct candevice_t *candev) { int ret; int i; - struct chip_t *chip = candev->chip[0]; + struct canchip_t *chip = candev->chip[0]; sCAN_CARD *chipext; @@ -761,8 +795,6 @@ int unican_init_hw_data(struct candevice_t *candev) return 0; } -#define CHIP_TYPE "unican" - /** * unican_init_chip_data - Initialize chips * @candev: Pointer to candevice/board structure @@ -773,8 +805,8 @@ int unican_init_hw_data(struct candevice_t *candev) */ int unican_init_chip_data(struct candevice_t *candev, int chipnr) { - struct chip_t *chip = candev->chip[chipnr]; - chip->chip_type = CHIP_TYPE; + struct canchip_t *chip = candev->chip[chipnr]; + chip->chip_type = "unican"; chip->chip_base_addr = 0; chip->clock = 10000000; chip->int_clk_reg = 0x0; @@ -799,9 +831,12 @@ int unican_init_chip_data(struct candevice_t *candev, int chipnr) chip->chipspecops->enable_configuration=unican_enable_configuration; chip->chipspecops->disable_configuration=unican_disable_configuration; chip->chipspecops->set_btregs=unican_set_btregs; + chip->chipspecops->attach_to_chip=unican_attach_to_chip; + chip->chipspecops->release_chip=unican_release_chip; chip->chipspecops->start_chip=unican_start_chip; chip->chipspecops->stop_chip=unican_stop_chip; chip->chipspecops->irq_handler=unican_irq_handler; + chip->chipspecops->irq_accept=unican_irq_accept; return 0; } @@ -814,7 +849,7 @@ int unican_init_chip_data(struct candevice_t *candev, int chipnr) * Return Value: The function always returns zero * File: src/unican.c */ -int unican_init_obj_data(struct chip_t *chip, int objnr) +int unican_init_obj_data(struct canchip_t *chip, int objnr) { struct msgobj_t *obj=chip->msgobj[objnr]; obj->obj_base_addr=chip->chip_base_addr; @@ -848,3 +883,123 @@ int unican_register(struct hwspecops_t *hwspecops) hwspecops->program_irq = unican_program_irq; return 0; } + + +/* Unicontrols PCI board specific functions */ + +#ifdef CAN_ENABLE_PCI_SUPPORT + +int unican_pci_request_io(struct candevice_t *candev) +{ + unsigned long remap_addr; + + #if (LINUX_VERSION_CODE > KERNEL_VERSION(2,4,21)) + if(pci_request_region(candev->sysdevptr.pcidev, 0, "unican_pci") != 0){ + CANMSG("Request of Unican PCI range failed\n"); + return -ENODEV; + } + #else /*(LINUX_VERSION_CODE > KERNEL_VERSION(2,4,21))*/ + if(pci_request_regions(candev->sysdevptr.pcidev, "kv_pcican") != 0){ + CANMSG("Request of Unican PCI range failed\n"); + return -ENODEV; + } + #endif /*(LINUX_VERSION_CODE > KERNEL_VERSION(2,4,21))*/ + + candev->dev_base_addr=pci_resource_start(candev->sysdevptr.pcidev,0); + candev->io_addr=candev->dev_base_addr; + candev->res_addr=candev->dev_base_addr; + + if ( !( remap_addr = (long) ioremap( candev->io_addr, IO_RANGE ) ) ) { + CANMSG("Unable to access I/O memory at: 0x%lx\n", candev->io_addr); + #if (LINUX_VERSION_CODE > KERNEL_VERSION(2,4,21)) + pci_release_region(candev->sysdevptr.pcidev, 0); + #else /*(LINUX_VERSION_CODE > KERNEL_VERSION(2,4,21))*/ + pci_release_regions(candev->sysdevptr.pcidev); + #endif /*(LINUX_VERSION_CODE > KERNEL_VERSION(2,4,21))*/ + return -ENODEV; + + } + can_base_addr_fixup(candev, remap_addr); + DEBUGMSG("Registered IO-memory: 0x%lx - 0x%lx\n", candev->io_addr, candev->io_addr + IO_RANGE - 1); + DEBUGMSG("VMA: dev_base_addr: 0x%lx chip_base_addr: 0x%lx\n", + candev->dev_base_addr, candev->chip[0]->chip_base_addr); + + return 0; +} + + +int unican_pci_release_io(struct candevice_t *candev) +{ + iounmap((void*)candev->dev_base_addr); + #if (LINUX_VERSION_CODE > KERNEL_VERSION(2,4,21)) + pci_release_region(candev->sysdevptr.pcidev, 0); + #else /*(LINUX_VERSION_CODE > KERNEL_VERSION(2,4,21))*/ + pci_release_regions(candev->sysdevptr.pcidev); + #endif /*(LINUX_VERSION_CODE > KERNEL_VERSION(2,4,21))*/ + return 0; +} + + +int unican_pci_init_hw_data(struct candevice_t *candev) +{ + struct pci_dev *pcidev = NULL; + + do { + pcidev = pci_find_device(UNICAN_PCI_VENDOR, UNICAN_PCI_ID, pcidev); + if(pcidev == NULL) return -ENODEV; + } while(can_check_dev_taken(pcidev)); + + if (pci_enable_device (pcidev)){ + printk(KERN_CRIT "Setup of Unican PCI failed\n"); + return -EIO; + } + candev->sysdevptr.pcidev=pcidev; + + if(!(pci_resource_flags(pcidev,0)&IORESOURCE_MEM)){ + printk(KERN_CRIT "Unican PCI region 0 is not MEM\n"); + return -EIO; + } + candev->dev_base_addr=pci_resource_start(pcidev,0); + candev->io_addr=candev->dev_base_addr; + candev->res_addr=candev->dev_base_addr; + + /*candev->flags |= CANDEV_PROGRAMMABLE_IRQ;*/ + + candev->nr_82527_chips=0; + candev->nr_sja1000_chips=0; + candev->nr_all_chips=1; + + return 0; +} + + +int unican_pci_init_chip_data(struct candevice_t *candev, int chipnr) +{ + int ret; + candev->chip[chipnr]->chip_irq=candev->sysdevptr.pcidev->irq; + ret = unican_init_chip_data(candev, chipnr); + candev->chip[chipnr]->flags |= CHIP_IRQ_PCI; + return ret; +} + +int unican_pci_register(struct hwspecops_t *hwspecops) +{ + hwspecops->request_io = unican_pci_request_io; + hwspecops->release_io = unican_pci_release_io; + hwspecops->reset = unican_reset; + hwspecops->init_hw_data = unican_pci_init_hw_data; + hwspecops->init_chip_data = unican_pci_init_chip_data; + hwspecops->init_obj_data = unican_init_obj_data; + hwspecops->write_register = NULL; + hwspecops->read_register = NULL; + hwspecops->program_irq = unican_program_irq; + return 0; +} + +#endif /*CAN_ENABLE_PCI_SUPPORT*/ + +#ifdef CAN_ENABLE_VME_SUPPORT + +#include "unican_vme.c" + +#endif /*CAN_ENABLE_VME_SUPPORT*/