2 * Linux CAN-bus device driver.
3 * Written by Arnaud Westenberg email:arnaud@wanadoo.nl
4 * Rewritten for new CAN queues by Pavel Pisa - OCERA team member
5 * email:pisa@cmp.felk.cvut.cz
6 * This software is released under the GPL-License.
7 * Version lincan-0.3 17 Jun 2004
10 #include "../include/can.h"
11 #include "../include/can_sysdep.h"
12 #include "../include/main.h"
13 #include "../include/devcommon.h"
14 #include "../include/setup.h"
15 #include "../include/finish.h"
17 int init_hwspecops(struct candevice_t *candev, int *irqnum_p);
18 int init_device_struct(int card, int *chan_param_idx_p, int *irq_param_idx_p);
19 int init_chip_struct(struct candevice_t *candev, int chipnr, int irq, long baudrate, long clock);
20 int init_obj_struct(struct candevice_t *candev, struct canchip_t *hostchip, int objnr);
23 * can_base_addr_fixup - relocates board physical memory addresses to the CPU accessible ones
24 * @candev: pointer to the previously filled device/board, chips and message objects structures
25 * @new_base: @candev new base address
27 * This function adapts base addresses of all structures of one board
28 * to the new board base address.
29 * It is required for translation between physical and virtual address mappings.
30 * This function is prepared to simplify board specific xxx_request_io() function
31 * for memory mapped devices.
33 int can_base_addr_fixup(struct candevice_t *candev, can_ioptr_t new_base)
38 offs=new_base-candev->dev_base_addr;
39 candev->dev_base_addr=new_base;
40 for(i=0;i<candev->nr_all_chips;i++){
41 candev->chip[i]->chip_base_addr += offs;
42 for(j=0;j<candev->chip[i]->max_objects;j++)
43 candev->chip[i]->msgobj[j]->obj_base_addr += offs;
49 * can_check_dev_taken - checks if bus device description is already taken by driver
50 * @anydev: pointer to bus specific Linux device description
52 * Returns: Returns 1 if device is already used by LinCAN driver, 0 otherwise.
54 int can_check_dev_taken(void *anydev)
57 struct candevice_t *candev;
60 for (board_nr=hardware_p->nr_boards; board_nr--; ) {
61 if((candev=hardware_p->candevice[board_nr])==NULL)
63 boarddev=candev->sysdevptr.anydev;
64 if(boarddev == anydev)
73 * register_obj_struct - registers message object into global array
74 * @obj: the initialized message object being registered
75 * @minorbase: wanted minor number, if (-1) automatically selected
77 * Return Value: returns negative number in the case of fail
79 int register_obj_struct(struct msgobj_t *obj, int minorbase)
81 static int next_minor=0;
86 if(next_minor>=MAX_TOT_MSGOBJS)
90 if(objects_p[i]==NULL){
96 if(++i >= MAX_TOT_MSGOBJS) i=0;
97 }while(i!=next_minor);
104 * register_chip_struct - registers chip into global array
105 * @chip: the initialized chip structure being registered
106 * @minorbase: wanted minor number base, if (-1) automatically selected
108 * Return Value: returns negative number in the case of fail
110 int register_chip_struct(struct canchip_t *chip, int minorbase)
112 static int next_chip_slot=0;
115 if(next_chip_slot>=MAX_TOT_CHIPS)
119 if(chips_p[i]==NULL){
125 if(++i >= MAX_TOT_CHIPS) i=0;
126 }while(i!=next_chip_slot);
133 * init_hw_struct - initializes driver hardware description structures
135 * The function init_hw_struct() is used to initialize the hardware structure.
137 * Return Value: returns negative number in the case of fail
139 int init_hw_struct(void)
143 int chan_param_idx=0;
145 hardware_p->nr_boards=0;
146 while ( (hw[i] != NULL) & (i < MAX_HW_CARDS) ) {
147 hardware_p->nr_boards++;
149 if (init_device_struct(i, &chan_param_idx, &irq_param_idx)) {
150 CANMSG("Error initializing candevice_t structures.\n");
160 * init_device_struct - initializes single CAN device/board
161 * @card: index into @hardware_p HW description
162 * @chan_param_idx_p: pointer to the index into arrays of the CAN channel parameters
163 * @irq_param_idx_p: pointer to the index into arrays of the per CAN channel IRQ parameters
165 * The function builds representation of the one board from parameters provided
166 * in the module parameters arrays:
167 * @hw[card] .. hardware type,
168 * @io[card] .. base IO address,
169 * @baudrate[chan_param_idx] .. per channel baudrate,
170 * @minor[chan_param_idx] .. optional specification of requested channel minor base,
171 * @irq[irq_param_idx] .. one or more board/chips IRQ parameters.
172 * The indexes are advanced after consumed parameters if the registration is successful.
174 * The hardware specific operations of the device/board are initialized by call to
175 * init_hwspecops() function. Then board data are initialized by board specific
176 * init_hw_data() function. Then chips and objects representation is build by
177 * init_chip_struct() function. If all above steps are successful, chips and
178 * message objects are registered into global arrays.
180 * Return Value: returns negative number in the case of fail
182 int init_device_struct(int card, int *chan_param_idx_p, int *irq_param_idx_p)
184 struct candevice_t *candev;
192 candev=(struct candevice_t *)can_checked_malloc(sizeof(struct candevice_t));
196 memset(candev, 0, sizeof(struct candevice_t));
198 hardware_p->candevice[card]=candev;
199 candev->candev_idx=card;
203 candev->hwname=hw[card];
204 candev->io_addr=io[card];
205 candev->dev_base_addr=io[card];
206 clock=clockfreq[card];
208 candev->hwspecops=(struct hwspecops_t *)can_checked_malloc(sizeof(struct hwspecops_t));
209 if (candev->hwspecops==NULL)
212 memset(candev->hwspecops, 0, sizeof(struct hwspecops_t));
214 if (init_hwspecops(candev, &irqnum))
217 if (candev->hwspecops->init_hw_data(candev))
220 /* Alocate and initialize the chip structures */
221 for (chipnr=0; chipnr < candev->nr_all_chips; chipnr++) {
224 irqsig=irq[*irq_param_idx_p+chipnr];
226 bd=baudrate[*chan_param_idx_p+chipnr];
227 if(!bd) bd=baudrate[0];
229 if ((ret=init_chip_struct(candev, chipnr, irqsig, bd*1000, clock*1000)))
235 for (chipnr=0; chipnr < candev->nr_all_chips; chipnr++) {
236 int m=minor[*chan_param_idx_p+chipnr];
237 struct canchip_t *chip=candev->chip[chipnr];
240 register_chip_struct(chip, m);
242 for (objnr=0; objnr<chip->max_objects; objnr++) {
243 register_obj_struct(chip->msgobj[objnr], m);
248 *irq_param_idx_p += irqnum;
249 *chan_param_idx_p += candev->nr_all_chips;
256 candevice_done(candev);
263 hardware_p->candevice[card]=NULL;
264 can_checked_free(candev);
270 * init_chip_struct - initializes one CAN chip structure
271 * @candev: pointer to the corresponding CAN device/board
272 * @chipnr: index of the chip in the corresponding device/board structure
273 * @irq: chip IRQ number or (-1) if not appropriate
274 * @baudrate: baudrate in the units of 1Bd
275 * @clock: optional chip base clock frequency in 1Hz step
277 * Chip structure is allocated and chip specific operations are filled by
278 * call to board specific init_chip_data() which calls chip specific
279 * fill_chipspecops(). The message objects are generated by
280 * calls to init_obj_struct() function.
282 * Return Value: returns negative number in the case of fail
284 int init_chip_struct(struct candevice_t *candev, int chipnr, int irq, long baudrate, long clock)
286 struct canchip_t *chip;
290 candev->chip[chipnr]=(struct canchip_t *)can_checked_malloc(sizeof(struct canchip_t));
291 if ((chip=candev->chip[chipnr])==NULL)
294 memset(chip, 0, sizeof(struct canchip_t));
296 chip->write_register=candev->hwspecops->write_register;
297 chip->read_register=candev->hwspecops->read_register;
299 chip->chipspecops=can_checked_malloc(sizeof(struct chipspecops_t));
300 if (chip->chipspecops==NULL)
302 memset(chip->chipspecops,0,sizeof(struct chipspecops_t));
304 chip->chip_idx=chipnr;
305 chip->hostdevice=candev;
307 chip->baudrate=baudrate;
311 if(candev->hwspecops->init_chip_data(candev,chipnr)<0)
314 for (objnr=0; objnr<chip->max_objects; objnr++) {
315 ret=init_obj_struct(candev, chip, objnr);
316 if(ret<0) return ret;
324 * init_obj_struct - initializes one CAN message object structure
325 * @candev: pointer to the corresponding CAN device/board
326 * @hostchip: pointer to the chip containing this object
327 * @objnr: index of the builded object in the chip structure
329 * The function initializes message object structure and allocates and initializes
330 * CAN queue chip ends structure.
332 * Return Value: returns negative number in the case of fail
334 int init_obj_struct(struct candevice_t *candev, struct canchip_t *hostchip, int objnr)
336 struct canque_ends_t *qends;
337 struct msgobj_t *obj;
340 obj=(struct msgobj_t *)can_checked_malloc(sizeof(struct msgobj_t));
341 hostchip->msgobj[objnr]=obj;
345 memset(obj, 0, sizeof(struct msgobj_t));
348 atomic_set(&obj->obj_used,0);
349 INIT_LIST_HEAD(&obj->obj_users);
350 init_timer(&obj->tx_timeout);
352 qends = (struct canque_ends_t *)can_checked_malloc(sizeof(struct canque_ends_t));
353 if(qends == NULL) return -ENOMEM;
354 memset(qends, 0, sizeof(struct canque_ends_t));
355 obj->hostchip=hostchip;
360 obj->obj_flags = 0x0;
362 ret=canqueue_ends_init_chip(qends, hostchip, obj);
363 if(ret<0) return ret;
365 ret=candev->hwspecops->init_obj_data(hostchip,objnr);
366 if(ret<0) return ret;
373 * init_hwspecops - finds and initializes board/device specific operations
374 * @candev: pointer to the corresponding CAN device/board
375 * @irqnum_p: optional pointer to the number of interrupts required by board
377 * The function searches board @hwname in the list of supported boards types.
378 * The board type specific board_register() function is used to initialize
379 * @hwspecops operations.
381 * Return Value: returns negative number in the case of fail
383 int init_hwspecops(struct candevice_t *candev, int *irqnum_p)
385 const struct boardtype_t *brp;
387 brp = boardtype_find(candev->hwname);
390 CANMSG("Sorry, hardware \"%s\" is currently not supported.\n",candev->hwname);
395 *irqnum_p=brp->irqnum;
396 brp->board_register(candev->hwspecops);