diff options
-rw-r--r-- | drivers/firewire/fw-cdev.c | 2 | ||||
-rw-r--r-- | drivers/firewire/fw-iso.c | 38 | ||||
-rw-r--r-- | include/linux/firewire-cdev.h | 10 |
3 files changed, 27 insertions, 23 deletions
diff --git a/drivers/firewire/fw-cdev.c b/drivers/firewire/fw-cdev.c index b93ad9c0a0d0..257b0c709a8b 100644 --- a/drivers/firewire/fw-cdev.c +++ b/drivers/firewire/fw-cdev.c | |||
@@ -1082,7 +1082,7 @@ static void iso_resource_work(struct work_struct *work) | |||
1082 | spin_unlock_irq(&client->lock); | 1082 | spin_unlock_irq(&client->lock); |
1083 | 1083 | ||
1084 | if (todo == ISO_RES_ALLOC && channel >= 0) | 1084 | if (todo == ISO_RES_ALLOC && channel >= 0) |
1085 | r->channels = 1ULL << (63 - channel); | 1085 | r->channels = 1ULL << channel; |
1086 | 1086 | ||
1087 | if (todo == ISO_RES_REALLOC && success) | 1087 | if (todo == ISO_RES_REALLOC && success) |
1088 | goto out; | 1088 | goto out; |
diff --git a/drivers/firewire/fw-iso.c b/drivers/firewire/fw-iso.c index a7b57b253b06..f511d16efaee 100644 --- a/drivers/firewire/fw-iso.c +++ b/drivers/firewire/fw-iso.c | |||
@@ -204,17 +204,19 @@ static int manage_bandwidth(struct fw_card *card, int irm_id, int generation, | |||
204 | } | 204 | } |
205 | 205 | ||
206 | static int manage_channel(struct fw_card *card, int irm_id, int generation, | 206 | static int manage_channel(struct fw_card *card, int irm_id, int generation, |
207 | __be32 channels_mask, u64 offset, bool allocate) | 207 | u32 channels_mask, u64 offset, bool allocate) |
208 | { | 208 | { |
209 | __be32 data[2], c, old = allocate ? cpu_to_be32(~0) : 0; | 209 | __be32 data[2], c, all, old; |
210 | int i, retry = 5; | 210 | int i, retry = 5; |
211 | 211 | ||
212 | old = all = allocate ? cpu_to_be32(~0) : 0; | ||
213 | |||
212 | for (i = 0; i < 32; i++) { | 214 | for (i = 0; i < 32; i++) { |
213 | c = cpu_to_be32(1 << (31 - i)); | 215 | if (!(channels_mask & 1 << i)) |
214 | if (!(channels_mask & c)) | ||
215 | continue; | 216 | continue; |
216 | 217 | ||
217 | if (allocate == !(old & c)) | 218 | c = cpu_to_be32(1 << (31 - i)); |
219 | if ((old & c) != (all & c)) | ||
218 | continue; | 220 | continue; |
219 | 221 | ||
220 | data[0] = old; | 222 | data[0] = old; |
@@ -233,7 +235,7 @@ static int manage_channel(struct fw_card *card, int irm_id, int generation, | |||
233 | old = data[0]; | 235 | old = data[0]; |
234 | 236 | ||
235 | /* Is the IRM 1394a-2000 compliant? */ | 237 | /* Is the IRM 1394a-2000 compliant? */ |
236 | if ((data[0] & c) != (data[1] & c)) | 238 | if ((data[0] & c) == (data[1] & c)) |
237 | continue; | 239 | continue; |
238 | 240 | ||
239 | /* 1394-1995 IRM, fall through to retry. */ | 241 | /* 1394-1995 IRM, fall through to retry. */ |
@@ -249,11 +251,10 @@ static int manage_channel(struct fw_card *card, int irm_id, int generation, | |||
249 | static void deallocate_channel(struct fw_card *card, int irm_id, | 251 | static void deallocate_channel(struct fw_card *card, int irm_id, |
250 | int generation, int channel) | 252 | int generation, int channel) |
251 | { | 253 | { |
252 | __be32 mask; | 254 | u32 mask; |
253 | u64 offset; | 255 | u64 offset; |
254 | 256 | ||
255 | mask = channel < 32 ? cpu_to_be32(1 << (31 - channel)) : | 257 | mask = channel < 32 ? 1 << channel : 1 << (channel - 32); |
256 | cpu_to_be32(1 << (63 - channel)); | ||
257 | offset = channel < 32 ? CSR_REGISTER_BASE + CSR_CHANNELS_AVAILABLE_HI : | 258 | offset = channel < 32 ? CSR_REGISTER_BASE + CSR_CHANNELS_AVAILABLE_HI : |
258 | CSR_REGISTER_BASE + CSR_CHANNELS_AVAILABLE_LO; | 259 | CSR_REGISTER_BASE + CSR_CHANNELS_AVAILABLE_LO; |
259 | 260 | ||
@@ -266,7 +267,12 @@ static void deallocate_channel(struct fw_card *card, int irm_id, | |||
266 | * In parameters: card, generation, channels_mask, bandwidth, allocate | 267 | * In parameters: card, generation, channels_mask, bandwidth, allocate |
267 | * Out parameters: channel, bandwidth | 268 | * Out parameters: channel, bandwidth |
268 | * This function blocks (sleeps) during communication with the IRM. | 269 | * This function blocks (sleeps) during communication with the IRM. |
270 | * | ||
269 | * Allocates or deallocates at most one channel out of channels_mask. | 271 | * Allocates or deallocates at most one channel out of channels_mask. |
272 | * channels_mask is a bitfield with MSB for channel 63 and LSB for channel 0. | ||
273 | * (Note, the IRM's CHANNELS_AVAILABLE is a big-endian bitfield with MSB for | ||
274 | * channel 0 and LSB for channel 63.) | ||
275 | * Allocates or deallocates as many bandwidth allocation units as specified. | ||
270 | * | 276 | * |
271 | * Returns channel < 0 if no channel was allocated or deallocated. | 277 | * Returns channel < 0 if no channel was allocated or deallocated. |
272 | * Returns bandwidth = 0 if no bandwidth was allocated or deallocated. | 278 | * Returns bandwidth = 0 if no bandwidth was allocated or deallocated. |
@@ -274,17 +280,17 @@ static void deallocate_channel(struct fw_card *card, int irm_id, | |||
274 | * If generation is stale, deallocations succeed but allocations fail with | 280 | * If generation is stale, deallocations succeed but allocations fail with |
275 | * channel = -EAGAIN. | 281 | * channel = -EAGAIN. |
276 | * | 282 | * |
277 | * If channel (de)allocation fails, bandwidth (de)allocation fails too. | 283 | * If channel allocation fails, no bandwidth will be allocated either. |
278 | * If bandwidth allocation fails, no channel will be allocated either. | 284 | * If bandwidth allocation fails, no channel will be allocated either. |
279 | * If bandwidth deallocation fails, channel deallocation may still have been | 285 | * But deallocations of channel and bandwidth are tried independently |
280 | * successful. | 286 | * of each other's success. |
281 | */ | 287 | */ |
282 | void fw_iso_resource_manage(struct fw_card *card, int generation, | 288 | void fw_iso_resource_manage(struct fw_card *card, int generation, |
283 | u64 channels_mask, int *channel, int *bandwidth, | 289 | u64 channels_mask, int *channel, int *bandwidth, |
284 | bool allocate) | 290 | bool allocate) |
285 | { | 291 | { |
286 | __be32 channels_hi = cpu_to_be32(channels_mask >> 32); | 292 | u32 channels_hi = channels_mask; /* channels 31...0 */ |
287 | __be32 channels_lo = cpu_to_be32(channels_mask); | 293 | u32 channels_lo = channels_mask >> 32; /* channels 63...32 */ |
288 | int irm_id, ret, c = -EINVAL; | 294 | int irm_id, ret, c = -EINVAL; |
289 | 295 | ||
290 | spin_lock_irq(&card->lock); | 296 | spin_lock_irq(&card->lock); |
@@ -302,7 +308,7 @@ void fw_iso_resource_manage(struct fw_card *card, int generation, | |||
302 | } | 308 | } |
303 | *channel = c; | 309 | *channel = c; |
304 | 310 | ||
305 | if (channels_mask != 0 && c < 0) | 311 | if (allocate && channels_mask != 0 && c < 0) |
306 | *bandwidth = 0; | 312 | *bandwidth = 0; |
307 | 313 | ||
308 | if (*bandwidth == 0) | 314 | if (*bandwidth == 0) |
@@ -312,7 +318,7 @@ void fw_iso_resource_manage(struct fw_card *card, int generation, | |||
312 | if (ret < 0) | 318 | if (ret < 0) |
313 | *bandwidth = 0; | 319 | *bandwidth = 0; |
314 | 320 | ||
315 | if (ret < 0 && c >= 0 && allocate) { | 321 | if (allocate && ret < 0 && c >= 0) { |
316 | deallocate_channel(card, irm_id, generation, c); | 322 | deallocate_channel(card, irm_id, generation, c); |
317 | *channel = ret; | 323 | *channel = ret; |
318 | } | 324 | } |
diff --git a/include/linux/firewire-cdev.h b/include/linux/firewire-cdev.h index 6ed9127680fd..2e35379bf96c 100644 --- a/include/linux/firewire-cdev.h +++ b/include/linux/firewire-cdev.h | |||
@@ -174,8 +174,6 @@ struct fw_cdev_event_iso_interrupt { | |||
174 | * @handle: Reference by which an allocated resource can be deallocated | 174 | * @handle: Reference by which an allocated resource can be deallocated |
175 | * @channel: Isochronous channel which was (de)allocated, if any | 175 | * @channel: Isochronous channel which was (de)allocated, if any |
176 | * @bandwidth: Bandwidth allocation units which were (de)allocated, if any | 176 | * @bandwidth: Bandwidth allocation units which were (de)allocated, if any |
177 | * @channels_available: Last known availability of channels | ||
178 | * @bandwidth_available: Last known availability of bandwidth | ||
179 | * | 177 | * |
180 | * An %FW_CDEV_EVENT_ISO_RESOURCE_ALLOCATED event is sent after an isochronous | 178 | * An %FW_CDEV_EVENT_ISO_RESOURCE_ALLOCATED event is sent after an isochronous |
181 | * resource was allocated at the IRM. The client has to check @channel and | 179 | * resource was allocated at the IRM. The client has to check @channel and |
@@ -580,7 +578,7 @@ struct fw_cdev_get_cycle_timer { | |||
580 | * | 578 | * |
581 | * The %FW_CDEV_IOC_DEALLOCATE_ISO_RESOURCE_ONCE ioctl works like | 579 | * The %FW_CDEV_IOC_DEALLOCATE_ISO_RESOURCE_ONCE ioctl works like |
582 | * %FW_CDEV_IOC_ALLOCATE_ISO_RESOURCE_ONCE except that resources are freed | 580 | * %FW_CDEV_IOC_ALLOCATE_ISO_RESOURCE_ONCE except that resources are freed |
583 | * instead of allocated. At most one channel may be specified in this ioctl. | 581 | * instead of allocated. |
584 | * An %FW_CDEV_EVENT_ISO_RESOURCE_DEALLOCATED event concludes this operation. | 582 | * An %FW_CDEV_EVENT_ISO_RESOURCE_DEALLOCATED event concludes this operation. |
585 | * | 583 | * |
586 | * To summarize, %FW_CDEV_IOC_DEALLOCATE_ISO_RESOURCE allocates iso resources | 584 | * To summarize, %FW_CDEV_IOC_DEALLOCATE_ISO_RESOURCE allocates iso resources |
@@ -588,9 +586,9 @@ struct fw_cdev_get_cycle_timer { | |||
588 | * In contrast, %FW_CDEV_IOC_ALLOCATE_ISO_RESOURCE_ONCE allocates iso resources | 586 | * In contrast, %FW_CDEV_IOC_ALLOCATE_ISO_RESOURCE_ONCE allocates iso resources |
589 | * for the duration of a bus generation. | 587 | * for the duration of a bus generation. |
590 | * | 588 | * |
591 | * @channels is a host-endian bitfield with the most significant bit | 589 | * @channels is a host-endian bitfield with the least significant bit |
592 | * representing channel 0 and the least significant bit representing channel 63: | 590 | * representing channel 0 and the most significant bit representing channel 63: |
593 | * 1ULL << (63 - c) | 591 | * 1ULL << c for each channel c that is a candidate for (de)allocation. |
594 | * | 592 | * |
595 | * @bandwidth is expressed in bandwidth allocation units, i.e. the time to send | 593 | * @bandwidth is expressed in bandwidth allocation units, i.e. the time to send |
596 | * one quadlet of data (payload or header data) at speed S1600. | 594 | * one quadlet of data (payload or header data) at speed S1600. |