* 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 lincan-0.2 9 Jul 2003
+ * Version lincan-0.3 17 Jun 2004
*/
#include "../include/can.h"
#include "../include/setup.h"
#include "../include/finish.h"
-extern int sja1000_register(struct chipspecops_t *chipspecops);
-extern int sja1000p_register(struct chipspecops_t *chipspecops);
-extern int i82527_register(struct chipspecops_t *chipspecops);
-
int init_hwspecops(struct candevice_t *candev, int *irqnum_p);
int init_device_struct(int card, int *chan_param_idx_p, int *irq_param_idx_p);
-int init_chip_struct(struct candevice_t *candev, int chipnr, int irq, long baudrate);
-int init_obj_struct(struct candevice_t *candev, struct chip_t *hostchip, int objnr);
-int init_chipspecops(struct candevice_t *candev, int chipnr);
-
-/**
- * can_checked_malloc - memory allocation with registering of requested blocks
- * @size: size of the requested block
- *
- * The function is used in the driver initialization phase to catch possible memory
- * leaks for future driver finalization or case, that driver initialization fail.
- *
- * Return Value: pointer to the allocated memory or NULL in the case of fail
- */
-void *can_checked_malloc(size_t size)
-{
- struct mem_addr *mem_new;
- void *address_p;
-
- address_p=kmalloc(size,GFP_KERNEL);
- if(address_p == NULL) {
- CANMSG("can_checked_malloc: out of the memory\n");
- return NULL;
- }
-
-#ifdef DEBUG_MEM
- DEBUGMSG("can_checked_malloc: allocated %d bytes at %p, mem_head=%p\n",
- (int)size, address_p, mem_head);
-#endif
-
- mem_new=(struct mem_addr *)kmalloc(sizeof(struct mem_addr),GFP_KERNEL);
- if (mem_new == NULL) {
- CANMSG("can_checked_malloc: memory list allocation error.\n");
- kfree(address_p);
- return NULL;
- }
- mem_new->next=mem_head;
- mem_new->address=address_p;
- mem_new->size=size;
- mem_head=mem_new;
-
- return address_p;
-}
-
-/**
- * can_checked_free - free memory allocated by can_checked_malloc()
- * @address_p: pointer to the memory block
- */
-int can_checked_free(void *address_p)
-{
- struct mem_addr **mem_pptr;
- struct mem_addr *mem_del=NULL;
-
-#ifdef DEBUG_MEM
- DEBUGMSG("can_checked_free %p, mem_head=%p\n", address_p, mem_head);
-#endif
-
- for(mem_pptr = &mem_head; (mem_del = *mem_pptr); mem_pptr = &mem_del->next) {
- if (mem_del->address != address_p)
- continue;
- *mem_pptr=mem_del->next;
- kfree(mem_del);
- kfree(address_p);
- return 0;
- }
-
- CANMSG("can_checked_free: address %p not found on the mem list\n", address_p);
-
- kfree(address_p);
- return -1;
-}
-
-
-/**
- * can_del_mem_list - check for stale memory allocations at driver finalization
- *
- * Checks, if there are still some memory blocks allocated and releases memory
- * occupied by such blocks back to the system
- */
-int can_del_mem_list(void)
-{
- struct mem_addr *mem;
-
-#ifdef DEBUG_MEM
- DEBUGMSG("can_del_mem_list, mem_head=%p\n", mem_head);
-#endif
- if(mem_head == NULL) {
- CANMSG("can_del_mem_list: no entries on the list - OK\n");
- return 0;
- }
-
- while((mem=mem_head) != NULL) {
- mem_head=mem->next;
- CANMSG("can_del_mem_list: deleting %p with size %d\n",
- mem->address, (int)mem->size);
- kfree(mem->address);
- kfree(mem);
- }
-
- return 0;
-}
-
-/**
- * can_request_io_region - request IO space region
- * @start: the first IO port address
- * @n: number of the consecutive IO port addresses
- * @name: name/label for the requested region
- *
- * The function hides system specific implementation of the feature.
- *
- * Return Value: returns positive value (1) in the case, that region could
- * be reserved for the driver. Returns zero (0) if there is collision with
- * other driver or region cannot be taken for some other reason.
- */
-int can_request_io_region(unsigned long start, unsigned long n, const char *name)
-{
- #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,4,0))
- if(check_region(start,n)) return 0;
- request_region(start,n,name);
- return 1;
- #else
- return (request_region(start,n,name))?1:0;
- #endif
-}
-
-/**
- * can_release_io_region - release IO space region
- * @start: the first IO port address
- * @n: number of the consecutive IO port addresses
- */
-void can_release_io_region(unsigned long start, unsigned long n)
-{
- release_region(start,n);
-}
-
-/**
- * can_request_mem_region - request memory space region
- * @start: the first memory port physical address
- * @n: number of the consecutive memory port addresses
- * @name: name/label for the requested region
- *
- * The function hides system specific implementation of the feature.
- *
- * Return Value: returns positive value (1) in the case, that region could
- * be reserved for the driver. Returns zero (0) if there is collision with
- * other driver or region cannot be taken for some other reason.
- */
-int can_request_mem_region(unsigned long start, unsigned long n, const char *name)
-{
- #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,4,0))
- return 1;
- #else
- return (request_mem_region(start,n,name))?1:0;
- #endif
-}
-
-/**
- * can_release_mem_region - release memory space region
- * @start: the first memory port physical address
- * @n: number of the consecutive memory port addresses
- */
-void can_release_mem_region(unsigned long start, unsigned long n)
-{
- #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,4,0))
- return;
- #else
- release_mem_region(start,n);
- #endif
-}
+int init_chip_struct(struct candevice_t *candev, int chipnr, int irq, long baudrate, long clock);
+int init_obj_struct(struct candevice_t *candev, struct canchip_t *hostchip, int objnr);
/**
* can_base_addr_fixup - relocates board physical memory addresses to the CPU accessible ones
* This function is prepared to simplify board specific xxx_request_io() function
* for memory mapped devices.
*/
-int can_base_addr_fixup(struct candevice_t *candev, unsigned long new_base)
+int can_base_addr_fixup(struct candevice_t *candev, can_ioptr_t new_base)
{
- unsigned long offs;
+ long offs;
int i, j;
offs=new_base-candev->dev_base_addr;
return 0;
}
+/**
+ * can_check_dev_taken - checks if bus device description is already taken by driver
+ * @anydev: pointer to bus specific Linux device description
+ *
+ * Returns: Returns 1 if device is already used by LinCAN driver, 0 otherwise.
+ */
+int can_check_dev_taken(void *anydev)
+{
+ int board_nr;
+ struct candevice_t *candev;
+ void *boarddev;
+
+ for (board_nr=hardware_p->nr_boards; board_nr--; ) {
+ if((candev=hardware_p->candevice[board_nr])==NULL)
+ continue;
+ boarddev=candev->sysdevptr.anydev;
+ if(boarddev == anydev)
+ return 1;
+ }
+
+ return 0;
+}
+
/**
* register_obj_struct - registers message object into global array
*
* Return Value: returns negative number in the case of fail
*/
-int register_chip_struct(struct chip_t *chip, int minorbase)
+int register_chip_struct(struct canchip_t *chip, int minorbase)
{
static int next_chip_slot=0;
int i;
int chipnr;
long bd;
int irqsig=-1;
+ long clock;
candev=(struct candevice_t *)can_checked_malloc(sizeof(struct candevice_t));
if (candev==NULL)
candev->hwname=hw[card];
candev->io_addr=io[card];
candev->dev_base_addr=io[card];
+ clock=clockfreq[card];
candev->hwspecops=(struct hwspecops_t *)can_checked_malloc(sizeof(struct hwspecops_t));
if (candev->hwspecops==NULL)
bd=baudrate[*chan_param_idx_p+chipnr];
if(!bd) bd=baudrate[0];
- if ((ret=init_chip_struct(candev, chipnr, irqsig, bd*1000)))
+ if ((ret=init_chip_struct(candev, chipnr, irqsig, bd*1000, clock*1000)))
goto error_chip;
}
for (chipnr=0; chipnr < candev->nr_all_chips; chipnr++) {
int m=minor[*chan_param_idx_p+chipnr];
- struct chip_t *chip=candev->chip[chipnr];
+ struct canchip_t *chip=candev->chip[chipnr];
int objnr;
register_chip_struct(chip, m);
* @chipnr: index of the chip in the corresponding device/board structure
* @irq: chip IRQ number or (-1) if not appropriate
* @baudrate: baudrate in the units of 1Bd
+ * @clock: optional chip base clock frequency in 1Hz step
*
* Chip structure is allocated and chip specific operations are filled by
- * call to board specific init_chip_data() function and generic
- * init_chipspecops() function. The message objects are generated by
+ * call to board specific init_chip_data() which calls chip specific
+ * fill_chipspecops(). The message objects are generated by
* calls to init_obj_struct() function.
*
* Return Value: returns negative number in the case of fail
*/
-int init_chip_struct(struct candevice_t *candev, int chipnr, int irq, long baudrate)
+int init_chip_struct(struct candevice_t *candev, int chipnr, int irq, long baudrate, long clock)
{
- struct chip_t *chip;
+ struct canchip_t *chip;
int objnr;
int ret;
- candev->chip[chipnr]=(struct chip_t *)can_checked_malloc(sizeof(struct chip_t));
+ candev->chip[chipnr]=(struct canchip_t *)can_checked_malloc(sizeof(struct canchip_t));
if ((chip=candev->chip[chipnr])==NULL)
return -ENOMEM;
- memset(chip, 0, sizeof(struct chip_t));
+ memset(chip, 0, sizeof(struct canchip_t));
chip->write_register=candev->hwspecops->write_register;
chip->read_register=candev->hwspecops->read_register;
chip->hostdevice=candev;
chip->chip_irq=irq;
chip->baudrate=baudrate;
+ chip->clock=clock;
chip->flags=0x0;
- candev->hwspecops->init_chip_data(candev,chipnr);
-
- if (init_chipspecops(candev,chipnr))
+ if(candev->hwspecops->init_chip_data(candev,chipnr)<0)
return -ENODEV;
for (objnr=0; objnr<chip->max_objects; objnr++) {
*
* Return Value: returns negative number in the case of fail
*/
-int init_obj_struct(struct candevice_t *candev, struct chip_t *hostchip, int objnr)
+int init_obj_struct(struct candevice_t *candev, struct canchip_t *hostchip, int objnr)
{
struct canque_ends_t *qends;
struct msgobj_t *obj;
return 0;
}
-
-
-/**
- * init_chipspecops - fills chip specific operations for board for known chip types
- * @candev: pointer to the corresponding CAN device/board
- * @chipnr: index of the chip in the device/board structure
- *
- * The function fills chip specific operations for next known generic chip
- * types "i82527", "sja1000", "sja1000p" (PeliCAN). Other non generic chip types
- * operations has to be initialized in the board specific init_chip_data() function.
- *
- * Return Value: returns negative number in the case of fail
- */
-int init_chipspecops(struct candevice_t *candev, int chipnr)
-{
- if (!strcmp(candev->chip[chipnr]->chip_type,"i82527")) {
- candev->chip[chipnr]->max_objects=15;
- i82527_register(candev->chip[chipnr]->chipspecops);
- }
- if (!strcmp(candev->chip[chipnr]->chip_type,"sja1000")) {
- candev->chip[chipnr]->max_objects=1;
- sja1000_register(candev->chip[chipnr]->chipspecops);
- }
- if (!strcmp(candev->chip[chipnr]->chip_type,"sja1000p")) {
- candev->chip[chipnr]->max_objects=1;
- sja1000p_register(candev->chip[chipnr]->chipspecops);
- }
-
- return 0;
-}
-
-#ifndef CAN_WITH_RTL
-
-/**
- * can_chip_setup_irq - attaches chip to the system interrupt processing
- * @chip: pointer to CAN chip structure
- *
- * Return Value: returns negative number in the case of fail
- */
-int can_chip_setup_irq(struct chip_t *chip)
-{
- if(chip==NULL)
- return -1;
- if(!chip->chipspecops->irq_handler)
- return 0;
-
- if (request_irq(chip->chip_irq,chip->chipspecops->irq_handler,SA_SHIRQ,DEVICE_NAME,chip))
- return -1;
- else {
- DEBUGMSG("Registered interrupt %d\n",chip->chip_irq);
- chip->flags |= CHIP_IRQ_SETUP;
- }
- return 1;
-}
-
-
-/**
- * can_chip_free_irq - unregisters chip interrupt handler from the system
- * @chip: pointer to CAN chip structure
- */
-void can_chip_free_irq(struct chip_t *chip)
-{
- if((chip->flags & CHIP_IRQ_SETUP) && (chip->chip_irq>=0)) {
- free_irq(chip->chip_irq, chip);
- chip->flags &= ~CHIP_IRQ_SETUP;
- }
-}
-
-#endif /*CAN_WITH_RTL*/