1a59d1b8e05ea drivers/firewire/core-iso.c (Thomas Gleixner 2019-05-27 08:55:05 +0200 1) // SPDX-License-Identifier: GPL-2.0-or-later
c781c06d119d0 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-05-07 20:33:32 -0400 2) /*
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 3) * Isochronous I/O functionality:
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 4) * - Isochronous DMA context management
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 5) * - Isochronous bus resource management (channels, bandwidth), client side
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 6) *
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 7) * Copyright (C) 2006 Kristian Hoegsberg <krh@bitplanet.net>
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 8) */
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 9)
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 10) #include <linux/dma-mapping.h>
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 11) #include <linux/errno.h>
77c9a5daa9c4d drivers/firewire/fw-iso.c (Stefan Richter 2009-06-05 16:26:18 +0200 12) #include <linux/firewire.h>
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 13) #include <linux/firewire-constants.h>
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 14) #include <linux/kernel.h>
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 15) #include <linux/mm.h>
5a0e3ad6af866 drivers/firewire/core-iso.c (Tejun Heo 2010-03-24 17:04:11 +0900 16) #include <linux/slab.h>
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 17) #include <linux/spinlock.h>
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 18) #include <linux/vmalloc.h>
823467e5fc0c8 drivers/firewire/core-iso.c (Paul Gortmaker 2011-07-10 12:16:32 -0400 19) #include <linux/export.h>
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 20)
e8ca97021c8eb drivers/firewire/fw-iso.c (Stefan Richter 2009-06-04 21:09:38 +0200 21) #include <asm/byteorder.h>
e8ca97021c8eb drivers/firewire/fw-iso.c (Stefan Richter 2009-06-04 21:09:38 +0200 22)
77c9a5daa9c4d drivers/firewire/fw-iso.c (Stefan Richter 2009-06-05 16:26:18 +0200 23) #include "core.h"
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 24)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 25) /*
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 26) * Isochronous DMA context management
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 27) */
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 28)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 29) int fw_iso_buffer_alloc(struct fw_iso_buffer *buffer, int page_count)
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 30) {
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 31) int i;
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 32)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 33) buffer->page_count = 0;
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 34) buffer->page_count_mapped = 0;
6da2ec56059c3 drivers/firewire/core-iso.c (Kees Cook 2018-06-12 13:55:00 -0700 35) buffer->pages = kmalloc_array(page_count, sizeof(buffer->pages[0]),
6da2ec56059c3 drivers/firewire/core-iso.c (Kees Cook 2018-06-12 13:55:00 -0700 36) GFP_KERNEL);
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 37) if (buffer->pages == NULL)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 38) return -ENOMEM;
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 39)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 40) for (i = 0; i < page_count; i++) {
68be3fa15a420 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:48 -0500 41) buffer->pages[i] = alloc_page(GFP_KERNEL | GFP_DMA32 | __GFP_ZERO);
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 42) if (buffer->pages[i] == NULL)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 43) break;
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 44) }
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 45) buffer->page_count = i;
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 46) if (i < page_count) {
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 47) fw_iso_buffer_destroy(buffer, NULL);
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 48) return -ENOMEM;
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 49) }
373b2edd864b8 drivers/firewire/fw-iso.c (Stefan Richter 2007-03-04 14:45:18 +0100 50)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 51) return 0;
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 52) }
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 53)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 54) int fw_iso_buffer_map_dma(struct fw_iso_buffer *buffer, struct fw_card *card,
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 55) enum dma_data_direction direction)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 56) {
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 57) dma_addr_t address;
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 58) int i;
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 59)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 60) buffer->direction = direction;
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 61)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 62) for (i = 0; i < buffer->page_count; i++) {
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 63) address = dma_map_page(card->device, buffer->pages[i],
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 64) 0, PAGE_SIZE, direction);
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 65) if (dma_mapping_error(card->device, address))
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 66) break;
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 67)
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 68) set_page_private(buffer->pages[i], address);
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 69) }
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 70) buffer->page_count_mapped = i;
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 71) if (i < buffer->page_count)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 72) return -ENOMEM;
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 73)
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 74) return 0;
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 75) }
82eff9db7dc5d drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-06 14:49:40 -0500 76)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 77) int fw_iso_buffer_init(struct fw_iso_buffer *buffer, struct fw_card *card,
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 78) int page_count, enum dma_data_direction direction)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 79) {
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 80) int ret;
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 81)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 82) ret = fw_iso_buffer_alloc(buffer, page_count);
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 83) if (ret < 0)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 84) return ret;
e1eff7a393d4a drivers/firewire/fw-iso.c (Stefan Richter 2009-02-03 17:55:19 +0100 85)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 86) ret = fw_iso_buffer_map_dma(buffer, card, direction);
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 87) if (ret < 0)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 88) fw_iso_buffer_destroy(buffer, card);
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 89)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 90) return ret;
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 91) }
c76acec6d5510 drivers/firewire/core-iso.c (Jay Fenlason 2009-05-18 13:08:06 -0400 92) EXPORT_SYMBOL(fw_iso_buffer_init);
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 93)
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 94) void fw_iso_buffer_destroy(struct fw_iso_buffer *buffer,
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 95) struct fw_card *card)
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 96) {
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 97) int i;
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 98) dma_addr_t address;
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 99)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 100) for (i = 0; i < buffer->page_count_mapped; i++) {
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 101) address = page_private(buffer->pages[i]);
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 102) dma_unmap_page(card->device, address,
29ad14cddd624 drivers/firewire/core-iso.c (Stefan Richter 2009-06-15 00:38:50 +0200 103) PAGE_SIZE, buffer->direction);
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 104) }
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 105) for (i = 0; i < buffer->page_count; i++)
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 106) __free_page(buffer->pages[i]);
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 107)
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 108) kfree(buffer->pages);
9aad8125389a7 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:38 -0500 109) buffer->pages = NULL;
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 110) buffer->page_count = 0;
0b6c4857f7684 drivers/firewire/core-iso.c (Stefan Richter 2012-04-09 20:51:18 +0200 111) buffer->page_count_mapped = 0;
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 112) }
c76acec6d5510 drivers/firewire/core-iso.c (Jay Fenlason 2009-05-18 13:08:06 -0400 113) EXPORT_SYMBOL(fw_iso_buffer_destroy);
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 114)
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 115) /* Convert DMA address to offset into virtually contiguous buffer. */
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 116) size_t fw_iso_buffer_lookup(struct fw_iso_buffer *buffer, dma_addr_t completed)
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 117) {
9d23f9e946ad7 drivers/firewire/core-iso.c (Clemens Ladisch 2012-06-13 22:28:24 +0200 118) size_t i;
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 119) dma_addr_t address;
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 120) ssize_t offset;
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 121)
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 122) for (i = 0; i < buffer->page_count; i++) {
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 123) address = page_private(buffer->pages[i]);
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 124) offset = (ssize_t)completed - (ssize_t)address;
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 125) if (offset > 0 && offset <= PAGE_SIZE)
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 126) return (i << PAGE_SHIFT) + offset;
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 127) }
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 128)
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 129) return 0;
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 130) }
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 131)
53dca51175cc2 drivers/firewire/fw-iso.c (Stefan Richter 2008-12-14 21:47:04 +0100 132) struct fw_iso_context *fw_iso_context_create(struct fw_card *card,
53dca51175cc2 drivers/firewire/fw-iso.c (Stefan Richter 2008-12-14 21:47:04 +0100 133) int type, int channel, int speed, size_t header_size,
53dca51175cc2 drivers/firewire/fw-iso.c (Stefan Richter 2008-12-14 21:47:04 +0100 134) fw_iso_callback_t callback, void *callback_data)
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 135) {
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 136) struct fw_iso_context *ctx;
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 137)
4817ed240232e drivers/firewire/fw-iso.c (Stefan Richter 2008-12-21 16:39:46 +0100 138) ctx = card->driver->allocate_iso_context(card,
4817ed240232e drivers/firewire/fw-iso.c (Stefan Richter 2008-12-21 16:39:46 +0100 139) type, channel, header_size);
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 140) if (IS_ERR(ctx))
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 141) return ctx;
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 142)
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 143) ctx->card = card;
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 144) ctx->type = type;
21efb3cfc6ed4 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:50 -0500 145) ctx->channel = channel;
21efb3cfc6ed4 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:50 -0500 146) ctx->speed = speed;
295e3feb92e50 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:40 -0500 147) ctx->header_size = header_size;
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 148) ctx->callback.sc = callback;
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 149) ctx->callback_data = callback_data;
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 150)
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 151) return ctx;
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 152) }
c76acec6d5510 drivers/firewire/core-iso.c (Jay Fenlason 2009-05-18 13:08:06 -0400 153) EXPORT_SYMBOL(fw_iso_context_create);
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 154)
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 155) void fw_iso_context_destroy(struct fw_iso_context *ctx)
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 156) {
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 157) ctx->card->driver->free_iso_context(ctx);
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 158) }
c76acec6d5510 drivers/firewire/core-iso.c (Jay Fenlason 2009-05-18 13:08:06 -0400 159) EXPORT_SYMBOL(fw_iso_context_destroy);
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 160)
53dca51175cc2 drivers/firewire/fw-iso.c (Stefan Richter 2008-12-14 21:47:04 +0100 161) int fw_iso_context_start(struct fw_iso_context *ctx,
53dca51175cc2 drivers/firewire/fw-iso.c (Stefan Richter 2008-12-14 21:47:04 +0100 162) int cycle, int sync, int tags)
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 163) {
eb0306eac0aad drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-03-14 17:34:54 -0400 164) return ctx->card->driver->start_iso(ctx, cycle, sync, tags);
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 165) }
c76acec6d5510 drivers/firewire/core-iso.c (Jay Fenlason 2009-05-18 13:08:06 -0400 166) EXPORT_SYMBOL(fw_iso_context_start);
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 167)
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 168) int fw_iso_context_set_channels(struct fw_iso_context *ctx, u64 *channels)
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 169) {
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 170) return ctx->card->driver->set_iso_channels(ctx, channels);
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 171) }
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 172)
53dca51175cc2 drivers/firewire/fw-iso.c (Stefan Richter 2008-12-14 21:47:04 +0100 173) int fw_iso_context_queue(struct fw_iso_context *ctx,
53dca51175cc2 drivers/firewire/fw-iso.c (Stefan Richter 2008-12-14 21:47:04 +0100 174) struct fw_iso_packet *packet,
53dca51175cc2 drivers/firewire/fw-iso.c (Stefan Richter 2008-12-14 21:47:04 +0100 175) struct fw_iso_buffer *buffer,
53dca51175cc2 drivers/firewire/fw-iso.c (Stefan Richter 2008-12-14 21:47:04 +0100 176) unsigned long payload)
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 177) {
872e330e38806 drivers/firewire/core-iso.c (Stefan Richter 2010-07-29 18:19:22 +0200 178) return ctx->card->driver->queue_iso(ctx, packet, buffer, payload);
3038e353cfaf5 drivers/firewire/fw-iso.c (Kristian Høgsberg 2006-12-19 19:58:27 -0500 179) }
c76acec6d5510 drivers/firewire/core-iso.c (Jay Fenlason 2009-05-18 13:08:06 -0400 180) EXPORT_SYMBOL(fw_iso_context_queue);
b82956685aab4 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:42 -0500 181)
13882a82ee164 drivers/firewire/core-iso.c (Clemens Ladisch 2011-05-02 09:33:56 +0200 182) void fw_iso_context_queue_flush(struct fw_iso_context *ctx)
13882a82ee164 drivers/firewire/core-iso.c (Clemens Ladisch 2011-05-02 09:33:56 +0200 183) {
13882a82ee164 drivers/firewire/core-iso.c (Clemens Ladisch 2011-05-02 09:33:56 +0200 184) ctx->card->driver->flush_queue_iso(ctx);
13882a82ee164 drivers/firewire/core-iso.c (Clemens Ladisch 2011-05-02 09:33:56 +0200 185) }
13882a82ee164 drivers/firewire/core-iso.c (Clemens Ladisch 2011-05-02 09:33:56 +0200 186) EXPORT_SYMBOL(fw_iso_context_queue_flush);
13882a82ee164 drivers/firewire/core-iso.c (Clemens Ladisch 2011-05-02 09:33:56 +0200 187)
d1bbd20972936 drivers/firewire/core-iso.c (Clemens Ladisch 2012-03-18 19:06:39 +0100 188) int fw_iso_context_flush_completions(struct fw_iso_context *ctx)
d1bbd20972936 drivers/firewire/core-iso.c (Clemens Ladisch 2012-03-18 19:06:39 +0100 189) {
d1bbd20972936 drivers/firewire/core-iso.c (Clemens Ladisch 2012-03-18 19:06:39 +0100 190) return ctx->card->driver->flush_iso_completions(ctx);
d1bbd20972936 drivers/firewire/core-iso.c (Clemens Ladisch 2012-03-18 19:06:39 +0100 191) }
d1bbd20972936 drivers/firewire/core-iso.c (Clemens Ladisch 2012-03-18 19:06:39 +0100 192) EXPORT_SYMBOL(fw_iso_context_flush_completions);
d1bbd20972936 drivers/firewire/core-iso.c (Clemens Ladisch 2012-03-18 19:06:39 +0100 193)
53dca51175cc2 drivers/firewire/fw-iso.c (Stefan Richter 2008-12-14 21:47:04 +0100 194) int fw_iso_context_stop(struct fw_iso_context *ctx)
b82956685aab4 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:42 -0500 195) {
b82956685aab4 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:42 -0500 196) return ctx->card->driver->stop_iso(ctx);
b82956685aab4 drivers/firewire/fw-iso.c (Kristian Høgsberg 2007-02-16 17:34:42 -0500 197) }
c76acec6d5510 drivers/firewire/core-iso.c (Jay Fenlason 2009-05-18 13:08:06 -0400 198) EXPORT_SYMBOL(fw_iso_context_stop);
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 199)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 200) /*
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 201) * Isochronous bus resource management (channels, bandwidth), client side
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 202) */
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 203)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 204) static int manage_bandwidth(struct fw_card *card, int irm_id, int generation,
f30e6d3e419bf drivers/firewire/core-iso.c (Stefan Richter 2011-04-22 15:13:54 +0200 205) int bandwidth, bool allocate)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 206) {
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 207) int try, new, old = allocate ? BANDWIDTH_AVAILABLE_INITIAL : 0;
f30e6d3e419bf drivers/firewire/core-iso.c (Stefan Richter 2011-04-22 15:13:54 +0200 208) __be32 data[2];
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 209)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 210) /*
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 211) * On a 1394a IRM with low contention, try < 1 is enough.
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 212) * On a 1394-1995 IRM, we need at least try < 2.
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 213) * Let's just do try < 5.
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 214) */
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 215) for (try = 0; try < 5; try++) {
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 216) new = allocate ? old - bandwidth : old + bandwidth;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 217) if (new < 0 || new > BANDWIDTH_AVAILABLE_INITIAL)
d6372b6e7c614 drivers/firewire/core-iso.c (Clemens Ladisch 2010-04-12 10:35:18 +0200 218) return -EBUSY;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 219)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 220) data[0] = cpu_to_be32(old);
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 221) data[1] = cpu_to_be32(new);
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 222) switch (fw_run_transaction(card, TCODE_LOCK_COMPARE_SWAP,
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 223) irm_id, generation, SCODE_100,
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 224) CSR_REGISTER_BASE + CSR_BANDWIDTH_AVAILABLE,
1821bc19d5400 drivers/firewire/core-iso.c (Stefan Richter 2009-09-05 13:23:49 +0200 225) data, 8)) {
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 226) case RCODE_GENERATION:
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 227) /* A generation change frees all bandwidth. */
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 228) return allocate ? -EAGAIN : bandwidth;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 229)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 230) case RCODE_COMPLETE:
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 231) if (be32_to_cpup(data) == old)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 232) return bandwidth;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 233)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 234) old = be32_to_cpup(data);
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 235) /* Fall through. */
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 236) }
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 237) }
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 238)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 239) return -EIO;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 240) }
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 241)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 242) static int manage_channel(struct fw_card *card, int irm_id, int generation,
f30e6d3e419bf drivers/firewire/core-iso.c (Stefan Richter 2011-04-22 15:13:54 +0200 243) u32 channels_mask, u64 offset, bool allocate)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 244) {
5aaffc65a27dd drivers/firewire/core-iso.c (Clemens Ladisch 2011-01-31 11:58:58 +0100 245) __be32 bit, all, old;
f30e6d3e419bf drivers/firewire/core-iso.c (Stefan Richter 2011-04-22 15:13:54 +0200 246) __be32 data[2];
5aaffc65a27dd drivers/firewire/core-iso.c (Clemens Ladisch 2011-01-31 11:58:58 +0100 247) int channel, ret = -EIO, retry = 5;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 248)
5d9cb7d276a9c drivers/firewire/fw-iso.c (Stefan Richter 2009-01-08 23:07:40 +0100 249) old = all = allocate ? cpu_to_be32(~0) : 0;
5d9cb7d276a9c drivers/firewire/fw-iso.c (Stefan Richter 2009-01-08 23:07:40 +0100 250)
5aaffc65a27dd drivers/firewire/core-iso.c (Clemens Ladisch 2011-01-31 11:58:58 +0100 251) for (channel = 0; channel < 32; channel++) {
5aaffc65a27dd drivers/firewire/core-iso.c (Clemens Ladisch 2011-01-31 11:58:58 +0100 252) if (!(channels_mask & 1 << channel))
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 253) continue;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 254)
d6372b6e7c614 drivers/firewire/core-iso.c (Clemens Ladisch 2010-04-12 10:35:18 +0200 255) ret = -EBUSY;
d6372b6e7c614 drivers/firewire/core-iso.c (Clemens Ladisch 2010-04-12 10:35:18 +0200 256)
5aaffc65a27dd drivers/firewire/core-iso.c (Clemens Ladisch 2011-01-31 11:58:58 +0100 257) bit = cpu_to_be32(1 << (31 - channel));
5aaffc65a27dd drivers/firewire/core-iso.c (Clemens Ladisch 2011-01-31 11:58:58 +0100 258) if ((old & bit) != (all & bit))
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 259) continue;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 260)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 261) data[0] = old;
5aaffc65a27dd drivers/firewire/core-iso.c (Clemens Ladisch 2011-01-31 11:58:58 +0100 262) data[1] = old ^ bit;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 263) switch (fw_run_transaction(card, TCODE_LOCK_COMPARE_SWAP,
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 264) irm_id, generation, SCODE_100,
1821bc19d5400 drivers/firewire/core-iso.c (Stefan Richter 2009-09-05 13:23:49 +0200 265) offset, data, 8)) {
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 266) case RCODE_GENERATION:
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 267) /* A generation change frees all channels. */
5aaffc65a27dd drivers/firewire/core-iso.c (Clemens Ladisch 2011-01-31 11:58:58 +0100 268) return allocate ? -EAGAIN : channel;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 269)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 270) case RCODE_COMPLETE:
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 271) if (data[0] == old)
5aaffc65a27dd drivers/firewire/core-iso.c (Clemens Ladisch 2011-01-31 11:58:58 +0100 272) return channel;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 273)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 274) old = data[0];
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 275)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 276) /* Is the IRM 1394a-2000 compliant? */
5aaffc65a27dd drivers/firewire/core-iso.c (Clemens Ladisch 2011-01-31 11:58:58 +0100 277) if ((data[0] & bit) == (data[1] & bit))
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 278) continue;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 279)
df561f6688fef drivers/firewire/core-iso.c (Gustavo A. R. Silva 2020-08-23 17:36:59 -0500 280) fallthrough; /* It's a 1394-1995 IRM, retry */
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 281) default:
3a1f0a0e3d871 drivers/firewire/core-iso.c (Clemens Ladisch 2010-04-12 10:35:05 +0200 282) if (retry) {
3a1f0a0e3d871 drivers/firewire/core-iso.c (Clemens Ladisch 2010-04-12 10:35:05 +0200 283) retry--;
5aaffc65a27dd drivers/firewire/core-iso.c (Clemens Ladisch 2011-01-31 11:58:58 +0100 284) channel--;
d6372b6e7c614 drivers/firewire/core-iso.c (Clemens Ladisch 2010-04-12 10:35:18 +0200 285) } else {
d6372b6e7c614 drivers/firewire/core-iso.c (Clemens Ladisch 2010-04-12 10:35:18 +0200 286) ret = -EIO;
3a1f0a0e3d871 drivers/firewire/core-iso.c (Clemens Ladisch 2010-04-12 10:35:05 +0200 287) }
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 288) }
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 289) }
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 290)
d6372b6e7c614 drivers/firewire/core-iso.c (Clemens Ladisch 2010-04-12 10:35:18 +0200 291) return ret;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 292) }
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 293)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 294) static void deallocate_channel(struct fw_card *card, int irm_id,
f30e6d3e419bf drivers/firewire/core-iso.c (Stefan Richter 2011-04-22 15:13:54 +0200 295) int generation, int channel)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 296) {
5d9cb7d276a9c drivers/firewire/fw-iso.c (Stefan Richter 2009-01-08 23:07:40 +0100 297) u32 mask;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 298) u64 offset;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 299)
5d9cb7d276a9c drivers/firewire/fw-iso.c (Stefan Richter 2009-01-08 23:07:40 +0100 300) mask = channel < 32 ? 1 << channel : 1 << (channel - 32);
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 301) offset = channel < 32 ? CSR_REGISTER_BASE + CSR_CHANNELS_AVAILABLE_HI :
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 302) CSR_REGISTER_BASE + CSR_CHANNELS_AVAILABLE_LO;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 303)
f30e6d3e419bf drivers/firewire/core-iso.c (Stefan Richter 2011-04-22 15:13:54 +0200 304) manage_channel(card, irm_id, generation, mask, offset, false);
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 305) }
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 306)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 307) /**
656b7afd40a9f drivers/firewire/core-iso.c (Stefan Richter 2010-07-07 13:26:18 +0200 308) * fw_iso_resource_manage() - Allocate or deallocate a channel and/or bandwidth
48f02b88c82b5 drivers/firewire/core-iso.c (Randy Dunlap 2018-09-04 17:02:22 -0700 309) * @card: card interface for this action
48f02b88c82b5 drivers/firewire/core-iso.c (Randy Dunlap 2018-09-04 17:02:22 -0700 310) * @generation: bus generation
48f02b88c82b5 drivers/firewire/core-iso.c (Randy Dunlap 2018-09-04 17:02:22 -0700 311) * @channels_mask: bitmask for channel allocation
48f02b88c82b5 drivers/firewire/core-iso.c (Randy Dunlap 2018-09-04 17:02:22 -0700 312) * @channel: pointer for returning channel allocation result
48f02b88c82b5 drivers/firewire/core-iso.c (Randy Dunlap 2018-09-04 17:02:22 -0700 313) * @bandwidth: pointer for returning bandwidth allocation result
48f02b88c82b5 drivers/firewire/core-iso.c (Randy Dunlap 2018-09-04 17:02:22 -0700 314) * @allocate: whether to allocate (true) or deallocate (false)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 315) *
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 316) * In parameters: card, generation, channels_mask, bandwidth, allocate
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 317) * Out parameters: channel, bandwidth
48f02b88c82b5 drivers/firewire/core-iso.c (Randy Dunlap 2018-09-04 17:02:22 -0700 318) *
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 319) * This function blocks (sleeps) during communication with the IRM.
5d9cb7d276a9c drivers/firewire/fw-iso.c (Stefan Richter 2009-01-08 23:07:40 +0100 320) *
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 321) * Allocates or deallocates at most one channel out of channels_mask.
5d9cb7d276a9c drivers/firewire/fw-iso.c (Stefan Richter 2009-01-08 23:07:40 +0100 322) * channels_mask is a bitfield with MSB for channel 63 and LSB for channel 0.
5d9cb7d276a9c drivers/firewire/fw-iso.c (Stefan Richter 2009-01-08 23:07:40 +0100 323) * (Note, the IRM's CHANNELS_AVAILABLE is a big-endian bitfield with MSB for
5d9cb7d276a9c drivers/firewire/fw-iso.c (Stefan Richter 2009-01-08 23:07:40 +0100 324) * channel 0 and LSB for channel 63.)
5d9cb7d276a9c drivers/firewire/fw-iso.c (Stefan Richter 2009-01-08 23:07:40 +0100 325) * Allocates or deallocates as many bandwidth allocation units as specified.
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 326) *
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 327) * Returns channel < 0 if no channel was allocated or deallocated.
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 328) * Returns bandwidth = 0 if no bandwidth was allocated or deallocated.
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 329) *
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 330) * If generation is stale, deallocations succeed but allocations fail with
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 331) * channel = -EAGAIN.
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 332) *
5d9cb7d276a9c drivers/firewire/fw-iso.c (Stefan Richter 2009-01-08 23:07:40 +0100 333) * If channel allocation fails, no bandwidth will be allocated either.
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 334) * If bandwidth allocation fails, no channel will be allocated either.
5d9cb7d276a9c drivers/firewire/fw-iso.c (Stefan Richter 2009-01-08 23:07:40 +0100 335) * But deallocations of channel and bandwidth are tried independently
5d9cb7d276a9c drivers/firewire/fw-iso.c (Stefan Richter 2009-01-08 23:07:40 +0100 336) * of each other's success.
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 337) */
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 338) void fw_iso_resource_manage(struct fw_card *card, int generation,
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 339) u64 channels_mask, int *channel, int *bandwidth,
f30e6d3e419bf drivers/firewire/core-iso.c (Stefan Richter 2011-04-22 15:13:54 +0200 340) bool allocate)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 341) {
5d9cb7d276a9c drivers/firewire/fw-iso.c (Stefan Richter 2009-01-08 23:07:40 +0100 342) u32 channels_hi = channels_mask; /* channels 31...0 */
5d9cb7d276a9c drivers/firewire/fw-iso.c (Stefan Richter 2009-01-08 23:07:40 +0100 343) u32 channels_lo = channels_mask >> 32; /* channels 63...32 */
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 344) int irm_id, ret, c = -EINVAL;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 345)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 346) spin_lock_irq(&card->lock);
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 347) irm_id = card->irm_node->node_id;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 348) spin_unlock_irq(&card->lock);
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 349)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 350) if (channels_hi)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 351) c = manage_channel(card, irm_id, generation, channels_hi,
6fdc03709433c drivers/firewire/core-iso.c (Stefan Richter 2009-06-20 13:23:59 +0200 352) CSR_REGISTER_BASE + CSR_CHANNELS_AVAILABLE_HI,
f30e6d3e419bf drivers/firewire/core-iso.c (Stefan Richter 2011-04-22 15:13:54 +0200 353) allocate);
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 354) if (channels_lo && c < 0) {
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 355) c = manage_channel(card, irm_id, generation, channels_lo,
6fdc03709433c drivers/firewire/core-iso.c (Stefan Richter 2009-06-20 13:23:59 +0200 356) CSR_REGISTER_BASE + CSR_CHANNELS_AVAILABLE_LO,
f30e6d3e419bf drivers/firewire/core-iso.c (Stefan Richter 2011-04-22 15:13:54 +0200 357) allocate);
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 358) if (c >= 0)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 359) c += 32;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 360) }
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 361) *channel = c;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 362)
5d9cb7d276a9c drivers/firewire/fw-iso.c (Stefan Richter 2009-01-08 23:07:40 +0100 363) if (allocate && channels_mask != 0 && c < 0)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 364) *bandwidth = 0;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 365)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 366) if (*bandwidth == 0)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 367) return;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 368)
f30e6d3e419bf drivers/firewire/core-iso.c (Stefan Richter 2011-04-22 15:13:54 +0200 369) ret = manage_bandwidth(card, irm_id, generation, *bandwidth, allocate);
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 370) if (ret < 0)
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 371) *bandwidth = 0;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 372)
cf36df6bfb49f drivers/firewire/core-iso.c (Clemens Ladisch 2010-03-15 13:20:32 +0100 373) if (allocate && ret < 0) {
cf36df6bfb49f drivers/firewire/core-iso.c (Clemens Ladisch 2010-03-15 13:20:32 +0100 374) if (c >= 0)
f30e6d3e419bf drivers/firewire/core-iso.c (Stefan Richter 2011-04-22 15:13:54 +0200 375) deallocate_channel(card, irm_id, generation, c);
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 376) *channel = ret;
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 377) }
b1bda4cdc2037 drivers/firewire/fw-iso.c (Jay Fenlason, Stefan Richter 2009-01-04 16:23:29 +0100 378) }
31ef9134eb526 drivers/firewire/core-iso.c (Clemens Ladisch 2011-03-15 07:53:21 +0100 379) EXPORT_SYMBOL(fw_iso_resource_manage);