19 #include <linux/can/rx-offload.h>
32 static inline bool can_rx_offload_le(struct can_rx_offload *offload, unsigned int a, unsigned int b)  in can_rx_offload_le()  argument
34 	if (offload->inc)  in can_rx_offload_le()
40 static inline unsigned int can_rx_offload_inc(struct can_rx_offload *offload, unsigned int *val)  in can_rx_offload_inc()  argument
42 	if (offload->inc)  in can_rx_offload_inc()
50 	struct can_rx_offload *offload = container_of(napi, struct can_rx_offload, napi);  in can_rx_offload_napi_poll()  local
51 	struct net_device *dev = offload->dev;  in can_rx_offload_napi_poll()
57 	       (skb = skb_dequeue(&offload->skb_queue))) {  in can_rx_offload_napi_poll()
70 		if (!skb_queue_empty(&offload->skb_queue))  in can_rx_offload_napi_poll()
71 			napi_reschedule(&offload->napi);  in can_rx_offload_napi_poll()
74 	can_led_event(offload->dev, CAN_LED_EVENT_RX);  in can_rx_offload_napi_poll()
121  * @offload: pointer to rx_offload context
141 can_rx_offload_offload_one(struct can_rx_offload *offload, unsigned int n)  in can_rx_offload_offload_one()  argument
148 	if (likely(skb_queue_len(&offload->skb_queue) <  in can_rx_offload_offload_one()
149 		   offload->skb_queue_len_max)) {  in can_rx_offload_offload_one()
150 		skb = alloc_can_skb(offload->dev, &cf);  in can_rx_offload_offload_one()
164 		ret = offload->mailbox_read(offload, &cf_overflow,  in can_rx_offload_offload_one()
176 		offload->dev->stats.rx_dropped++;  in can_rx_offload_offload_one()
177 		offload->dev->stats.rx_fifo_errors++;  in can_rx_offload_offload_one()
189 	ret = offload->mailbox_read(offload, cf, &cb->timestamp, n);  in can_rx_offload_offload_one()
201 		offload->dev->stats.rx_dropped++;  in can_rx_offload_offload_one()
202 		offload->dev->stats.rx_fifo_errors++;  in can_rx_offload_offload_one()
211 int can_rx_offload_irq_offload_timestamp(struct can_rx_offload *offload, u64 pending)  in can_rx_offload_irq_offload_timestamp()  argument
218 	for (i = offload->mb_first;  in can_rx_offload_irq_offload_timestamp()
219 	     can_rx_offload_le(offload, i, offload->mb_last);  in can_rx_offload_irq_offload_timestamp()
220 	     can_rx_offload_inc(offload, &i)) {  in can_rx_offload_irq_offload_timestamp()
226 		skb = can_rx_offload_offload_one(offload, i);  in can_rx_offload_irq_offload_timestamp()
237 		spin_lock_irqsave(&offload->skb_queue.lock, flags);  in can_rx_offload_irq_offload_timestamp()
238 		skb_queue_splice_tail(&skb_queue, &offload->skb_queue);  in can_rx_offload_irq_offload_timestamp()
239 		spin_unlock_irqrestore(&offload->skb_queue.lock, flags);  in can_rx_offload_irq_offload_timestamp()
241 		if ((queue_len = skb_queue_len(&offload->skb_queue)) >  in can_rx_offload_irq_offload_timestamp()
242 		    (offload->skb_queue_len_max / 8))  in can_rx_offload_irq_offload_timestamp()
243 			netdev_dbg(offload->dev, "%s: queue_len=%d\n",  in can_rx_offload_irq_offload_timestamp()
246 		can_rx_offload_schedule(offload);  in can_rx_offload_irq_offload_timestamp()
253 int can_rx_offload_irq_offload_fifo(struct can_rx_offload *offload)  in can_rx_offload_irq_offload_fifo()  argument
259 		skb = can_rx_offload_offload_one(offload, 0);  in can_rx_offload_irq_offload_fifo()
265 		skb_queue_tail(&offload->skb_queue, skb);  in can_rx_offload_irq_offload_fifo()
270 		can_rx_offload_schedule(offload);  in can_rx_offload_irq_offload_fifo()
276 int can_rx_offload_queue_sorted(struct can_rx_offload *offload,  in can_rx_offload_queue_sorted()  argument
282 	if (skb_queue_len(&offload->skb_queue) >  in can_rx_offload_queue_sorted()
283 	    offload->skb_queue_len_max) {  in can_rx_offload_queue_sorted()
291 	spin_lock_irqsave(&offload->skb_queue.lock, flags);  in can_rx_offload_queue_sorted()
292 	__skb_queue_add_sort(&offload->skb_queue, skb, can_rx_offload_compare);  in can_rx_offload_queue_sorted()
293 	spin_unlock_irqrestore(&offload->skb_queue.lock, flags);  in can_rx_offload_queue_sorted()
295 	can_rx_offload_schedule(offload);  in can_rx_offload_queue_sorted()
301 unsigned int can_rx_offload_get_echo_skb(struct can_rx_offload *offload,  in can_rx_offload_get_echo_skb()  argument
304 	struct net_device *dev = offload->dev;  in can_rx_offload_get_echo_skb()
314 	err = can_rx_offload_queue_sorted(offload, skb, timestamp);  in can_rx_offload_get_echo_skb()
324 int can_rx_offload_queue_tail(struct can_rx_offload *offload,  in can_rx_offload_queue_tail()  argument
327 	if (skb_queue_len(&offload->skb_queue) >  in can_rx_offload_queue_tail()
328 	    offload->skb_queue_len_max) {  in can_rx_offload_queue_tail()
333 	skb_queue_tail(&offload->skb_queue, skb);  in can_rx_offload_queue_tail()
334 	can_rx_offload_schedule(offload);  in can_rx_offload_queue_tail()
340 static int can_rx_offload_init_queue(struct net_device *dev, struct can_rx_offload *offload, unsign…  in can_rx_offload_init_queue()  argument
342 	offload->dev = dev;  in can_rx_offload_init_queue()
345 	offload->skb_queue_len_max = 2 << fls(weight);  in can_rx_offload_init_queue()
346 	offload->skb_queue_len_max *= 4;  in can_rx_offload_init_queue()
347 	skb_queue_head_init(&offload->skb_queue);  in can_rx_offload_init_queue()
349 	can_rx_offload_reset(offload);  in can_rx_offload_init_queue()
350 	netif_napi_add(dev, &offload->napi, can_rx_offload_napi_poll, weight);  in can_rx_offload_init_queue()
353 		__func__, offload->skb_queue_len_max);  in can_rx_offload_init_queue()
358 int can_rx_offload_add_timestamp(struct net_device *dev, struct can_rx_offload *offload)  in can_rx_offload_add_timestamp()  argument
362 	if (offload->mb_first > BITS_PER_LONG_LONG ||  in can_rx_offload_add_timestamp()
363 	    offload->mb_last > BITS_PER_LONG_LONG || !offload->mailbox_read)  in can_rx_offload_add_timestamp()
366 	if (offload->mb_first < offload->mb_last) {  in can_rx_offload_add_timestamp()
367 		offload->inc = true;  in can_rx_offload_add_timestamp()
368 		weight = offload->mb_last - offload->mb_first;  in can_rx_offload_add_timestamp()
370 		offload->inc = false;  in can_rx_offload_add_timestamp()
371 		weight = offload->mb_first - offload->mb_last;  in can_rx_offload_add_timestamp()
374 	return can_rx_offload_init_queue(dev, offload, weight);  in can_rx_offload_add_timestamp()
378 int can_rx_offload_add_fifo(struct net_device *dev, struct can_rx_offload *offload, unsigned int we…  in can_rx_offload_add_fifo()  argument
380 	if (!offload->mailbox_read)  in can_rx_offload_add_fifo()
383 	return can_rx_offload_init_queue(dev, offload, weight);  in can_rx_offload_add_fifo()
387 void can_rx_offload_enable(struct can_rx_offload *offload)  in can_rx_offload_enable()  argument
389 	can_rx_offload_reset(offload);  in can_rx_offload_enable()
390 	napi_enable(&offload->napi);  in can_rx_offload_enable()
394 void can_rx_offload_del(struct can_rx_offload *offload)  in can_rx_offload_del()  argument
396 	netif_napi_del(&offload->napi);  in can_rx_offload_del()
397 	skb_queue_purge(&offload->skb_queue);  in can_rx_offload_del()
401 void can_rx_offload_reset(struct can_rx_offload *offload)  in can_rx_offload_reset()  argument