2 * Core IEEE1394 transaction logic
4 * Copyright (C) 2004-2006 Kristian Hoegsberg <krh@bitplanet.net>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software Foundation,
18 * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
21 #include <linux/completion.h>
22 #include <linux/kernel.h>
23 #include <linux/module.h>
24 #include <linux/init.h>
25 #include <linux/interrupt.h>
26 #include <linux/pci.h>
27 #include <linux/delay.h>
28 #include <linux/poll.h>
29 #include <linux/list.h>
30 #include <linux/kthread.h>
31 #include <asm/uaccess.h>
32 #include <asm/semaphore.h>
34 #include "fw-transaction.h"
35 #include "fw-topology.h"
36 #include "fw-device.h"
38 #define HEADER_PRI(pri) ((pri) << 0)
39 #define HEADER_TCODE(tcode) ((tcode) << 4)
40 #define HEADER_RETRY(retry) ((retry) << 8)
41 #define HEADER_TLABEL(tlabel) ((tlabel) << 10)
42 #define HEADER_DESTINATION(destination) ((destination) << 16)
43 #define HEADER_SOURCE(source) ((source) << 16)
44 #define HEADER_RCODE(rcode) ((rcode) << 12)
45 #define HEADER_OFFSET_HIGH(offset_high) ((offset_high) << 0)
46 #define HEADER_DATA_LENGTH(length) ((length) << 16)
47 #define HEADER_EXTENDED_TCODE(tcode) ((tcode) << 0)
49 #define HEADER_GET_TCODE(q) (((q) >> 4) & 0x0f)
50 #define HEADER_GET_TLABEL(q) (((q) >> 10) & 0x3f)
51 #define HEADER_GET_RCODE(q) (((q) >> 12) & 0x0f)
52 #define HEADER_GET_DESTINATION(q) (((q) >> 16) & 0xffff)
53 #define HEADER_GET_SOURCE(q) (((q) >> 16) & 0xffff)
54 #define HEADER_GET_OFFSET_HIGH(q) (((q) >> 0) & 0xffff)
55 #define HEADER_GET_DATA_LENGTH(q) (((q) >> 16) & 0xffff)
56 #define HEADER_GET_EXTENDED_TCODE(q) (((q) >> 0) & 0xffff)
58 #define PHY_CONFIG_GAP_COUNT(gap_count) (((gap_count) << 16) | (1 << 22))
59 #define PHY_CONFIG_ROOT_ID(node_id) ((((node_id) & 0x3f) << 24) | (1 << 23))
60 #define PHY_IDENTIFIER(id) ((id) << 30)
63 close_transaction(struct fw_transaction
*transaction
,
64 struct fw_card
*card
, int rcode
,
65 u32
*payload
, size_t length
)
67 struct fw_transaction
*t
;
70 spin_lock_irqsave(&card
->lock
, flags
);
71 list_for_each_entry(t
, &card
->transaction_list
, link
) {
72 if (t
== transaction
) {
74 card
->tlabel_mask
&= ~(1 << t
->tlabel
);
78 spin_unlock_irqrestore(&card
->lock
, flags
);
80 if (&t
->link
!= &card
->transaction_list
) {
81 t
->callback(card
, rcode
, payload
, length
, t
->callback_data
);
89 * Only valid for transactions that are potentially pending (ie have
93 fw_cancel_transaction(struct fw_card
*card
,
94 struct fw_transaction
*transaction
)
97 * Cancel the packet transmission if it's still queued. That
98 * will call the packet transmission callback which cancels
102 if (card
->driver
->cancel_packet(card
, &transaction
->packet
) == 0)
106 * If the request packet has already been sent, we need to see
107 * if the transaction is still pending and remove it in that case.
110 return close_transaction(transaction
, card
, RCODE_CANCELLED
, NULL
, 0);
112 EXPORT_SYMBOL(fw_cancel_transaction
);
115 transmit_complete_callback(struct fw_packet
*packet
,
116 struct fw_card
*card
, int status
)
118 struct fw_transaction
*t
=
119 container_of(packet
, struct fw_transaction
, packet
);
123 close_transaction(t
, card
, RCODE_COMPLETE
, NULL
, 0);
126 t
->timestamp
= packet
->timestamp
;
131 close_transaction(t
, card
, RCODE_BUSY
, NULL
, 0);
134 close_transaction(t
, card
, RCODE_DATA_ERROR
, NULL
, 0);
137 close_transaction(t
, card
, RCODE_TYPE_ERROR
, NULL
, 0);
141 * In this case the ack is really a juju specific
142 * rcode, so just forward that to the callback.
144 close_transaction(t
, card
, status
, NULL
, 0);
150 fw_fill_request(struct fw_packet
*packet
, int tcode
, int tlabel
,
151 int node_id
, int source_id
, int generation
, int speed
,
152 unsigned long long offset
, void *payload
, size_t length
)
157 ext_tcode
= tcode
& ~0x10;
158 tcode
= TCODE_LOCK_REQUEST
;
163 HEADER_RETRY(RETRY_X
) |
164 HEADER_TLABEL(tlabel
) |
165 HEADER_TCODE(tcode
) |
166 HEADER_DESTINATION(node_id
);
168 HEADER_OFFSET_HIGH(offset
>> 32) | HEADER_SOURCE(source_id
);
173 case TCODE_WRITE_QUADLET_REQUEST
:
174 packet
->header
[3] = *(u32
*)payload
;
175 packet
->header_length
= 16;
176 packet
->payload_length
= 0;
179 case TCODE_LOCK_REQUEST
:
180 case TCODE_WRITE_BLOCK_REQUEST
:
182 HEADER_DATA_LENGTH(length
) |
183 HEADER_EXTENDED_TCODE(ext_tcode
);
184 packet
->header_length
= 16;
185 packet
->payload
= payload
;
186 packet
->payload_length
= length
;
189 case TCODE_READ_QUADLET_REQUEST
:
190 packet
->header_length
= 12;
191 packet
->payload_length
= 0;
194 case TCODE_READ_BLOCK_REQUEST
:
196 HEADER_DATA_LENGTH(length
) |
197 HEADER_EXTENDED_TCODE(ext_tcode
);
198 packet
->header_length
= 16;
199 packet
->payload_length
= 0;
203 packet
->speed
= speed
;
204 packet
->generation
= generation
;
209 * This function provides low-level access to the IEEE1394 transaction
210 * logic. Most C programs would use either fw_read(), fw_write() or
211 * fw_lock() instead - those function are convenience wrappers for
212 * this function. The fw_send_request() function is primarily
213 * provided as a flexible, one-stop entry point for languages bindings
214 * and protocol bindings.
216 * FIXME: Document this function further, in particular the possible
217 * values for rcode in the callback. In short, we map ACK_COMPLETE to
218 * RCODE_COMPLETE, internal errors set errno and set rcode to
219 * RCODE_SEND_ERROR (which is out of range for standard ieee1394
220 * rcodes). All other rcodes are forwarded unchanged. For all
221 * errors, payload is NULL, length is 0.
223 * Can not expect the callback to be called before the function
224 * returns, though this does happen in some cases (ACK_COMPLETE and
227 * The payload is only used for write requests and must not be freed
228 * until the callback has been called.
230 * @param card the card from which to send the request
231 * @param tcode the tcode for this transaction. Do not use
232 * TCODE_LOCK_REQUEST directly, instead use TCODE_LOCK_MASK_SWAP
233 * etc. to specify tcode and ext_tcode.
234 * @param node_id the destination node ID (bus ID and PHY ID concatenated)
235 * @param generation the generation for which node_id is valid
236 * @param speed the speed to use for sending the request
237 * @param offset the 48 bit offset on the destination node
238 * @param payload the data payload for the request subaction
239 * @param length the length in bytes of the data to read
240 * @param callback function to be called when the transaction is completed
241 * @param callback_data pointer to arbitrary data, which will be
242 * passed to the callback
245 fw_send_request(struct fw_card
*card
, struct fw_transaction
*t
,
246 int tcode
, int node_id
, int generation
, int speed
,
247 unsigned long long offset
,
248 void *payload
, size_t length
,
249 fw_transaction_callback_t callback
, void *callback_data
)
255 * Bump the flush timer up 100ms first of all so we
256 * don't race with a flush timer callback.
259 mod_timer(&card
->flush_timer
, jiffies
+ DIV_ROUND_UP(HZ
, 10));
262 * Allocate tlabel from the bitmap and put the transaction on
263 * the list while holding the card spinlock.
266 spin_lock_irqsave(&card
->lock
, flags
);
268 source
= card
->node_id
;
269 tlabel
= card
->current_tlabel
;
270 if (card
->tlabel_mask
& (1 << tlabel
)) {
271 spin_unlock_irqrestore(&card
->lock
, flags
);
272 callback(card
, RCODE_SEND_ERROR
, NULL
, 0, callback_data
);
276 card
->current_tlabel
= (card
->current_tlabel
+ 1) & 0x1f;
277 card
->tlabel_mask
|= (1 << tlabel
);
279 list_add_tail(&t
->link
, &card
->transaction_list
);
281 spin_unlock_irqrestore(&card
->lock
, flags
);
283 /* Initialize rest of transaction, fill out packet and send it. */
284 t
->node_id
= node_id
;
286 t
->callback
= callback
;
287 t
->callback_data
= callback_data
;
289 fw_fill_request(&t
->packet
, tcode
, t
->tlabel
,
290 node_id
, source
, generation
,
291 speed
, offset
, payload
, length
);
292 t
->packet
.callback
= transmit_complete_callback
;
294 card
->driver
->send_request(card
, &t
->packet
);
296 EXPORT_SYMBOL(fw_send_request
);
298 struct fw_phy_packet
{
299 struct fw_packet packet
;
300 struct completion done
;
304 transmit_phy_packet_callback(struct fw_packet
*packet
,
305 struct fw_card
*card
, int status
)
307 struct fw_phy_packet
*p
=
308 container_of(packet
, struct fw_phy_packet
, packet
);
313 void fw_send_phy_config(struct fw_card
*card
,
314 int node_id
, int generation
, int gap_count
)
316 struct fw_phy_packet p
;
317 u32 data
= PHY_IDENTIFIER(PHY_PACKET_CONFIG
) |
318 PHY_CONFIG_ROOT_ID(node_id
) |
319 PHY_CONFIG_GAP_COUNT(gap_count
);
321 p
.packet
.header
[0] = data
;
322 p
.packet
.header
[1] = ~data
;
323 p
.packet
.header_length
= 8;
324 p
.packet
.payload_length
= 0;
325 p
.packet
.speed
= SCODE_100
;
326 p
.packet
.generation
= generation
;
327 p
.packet
.callback
= transmit_phy_packet_callback
;
328 init_completion(&p
.done
);
330 card
->driver
->send_request(card
, &p
.packet
);
331 wait_for_completion(&p
.done
);
334 void fw_flush_transactions(struct fw_card
*card
)
336 struct fw_transaction
*t
, *next
;
337 struct list_head list
;
340 INIT_LIST_HEAD(&list
);
341 spin_lock_irqsave(&card
->lock
, flags
);
342 list_splice_init(&card
->transaction_list
, &list
);
343 card
->tlabel_mask
= 0;
344 spin_unlock_irqrestore(&card
->lock
, flags
);
346 list_for_each_entry_safe(t
, next
, &list
, link
) {
347 card
->driver
->cancel_packet(card
, &t
->packet
);
350 * At this point cancel_packet will never call the
351 * transaction callback, since we just took all the
352 * transactions out of the list. So do it here.
354 t
->callback(card
, RCODE_CANCELLED
, NULL
, 0, t
->callback_data
);
358 static struct fw_address_handler
*
359 lookup_overlapping_address_handler(struct list_head
*list
,
360 unsigned long long offset
, size_t length
)
362 struct fw_address_handler
*handler
;
364 list_for_each_entry(handler
, list
, link
) {
365 if (handler
->offset
< offset
+ length
&&
366 offset
< handler
->offset
+ handler
->length
)
373 static struct fw_address_handler
*
374 lookup_enclosing_address_handler(struct list_head
*list
,
375 unsigned long long offset
, size_t length
)
377 struct fw_address_handler
*handler
;
379 list_for_each_entry(handler
, list
, link
) {
380 if (handler
->offset
<= offset
&&
381 offset
+ length
<= handler
->offset
+ handler
->length
)
388 static DEFINE_SPINLOCK(address_handler_lock
);
389 static LIST_HEAD(address_handler_list
);
391 const struct fw_address_region fw_low_memory_region
=
392 { .start
= 0x000000000000ULL
, .end
= 0x000100000000ULL
, };
393 const struct fw_address_region fw_high_memory_region
=
394 { .start
= 0x000100000000ULL
, .end
= 0xffffe0000000ULL
, };
395 const struct fw_address_region fw_private_region
=
396 { .start
= 0xffffe0000000ULL
, .end
= 0xfffff0000000ULL
, };
397 const struct fw_address_region fw_csr_region
=
398 { .start
= CSR_REGISTER_BASE
,
399 .end
= CSR_REGISTER_BASE
| CSR_CONFIG_ROM_END
, };
400 const struct fw_address_region fw_unit_space_region
=
401 { .start
= 0xfffff0000900ULL
, .end
= 0x1000000000000ULL
, };
402 EXPORT_SYMBOL(fw_low_memory_region
);
403 EXPORT_SYMBOL(fw_high_memory_region
);
404 EXPORT_SYMBOL(fw_private_region
);
405 EXPORT_SYMBOL(fw_csr_region
);
406 EXPORT_SYMBOL(fw_unit_space_region
);
409 * Allocate a range of addresses in the node space of the OHCI
410 * controller. When a request is received that falls within the
411 * specified address range, the specified callback is invoked. The
412 * parameters passed to the callback give the details of the
413 * particular request.
415 * Return value: 0 on success, non-zero otherwise.
416 * The start offset of the handler's address region is determined by
417 * fw_core_add_address_handler() and is returned in handler->offset.
418 * The offset is quadlet-aligned.
421 fw_core_add_address_handler(struct fw_address_handler
*handler
,
422 const struct fw_address_region
*region
)
424 struct fw_address_handler
*other
;
428 spin_lock_irqsave(&address_handler_lock
, flags
);
430 handler
->offset
= roundup(region
->start
, 4);
431 while (handler
->offset
+ handler
->length
<= region
->end
) {
433 lookup_overlapping_address_handler(&address_handler_list
,
438 roundup(other
->offset
+ other
->length
, 4);
440 list_add_tail(&handler
->link
, &address_handler_list
);
446 spin_unlock_irqrestore(&address_handler_lock
, flags
);
450 EXPORT_SYMBOL(fw_core_add_address_handler
);
453 * Deallocate a range of addresses allocated with fw_allocate. This
454 * will call the associated callback one last time with a the special
455 * tcode TCODE_DEALLOCATE, to let the client destroy the registered
456 * callback data. For convenience, the callback parameters offset and
457 * length are set to the start and the length respectively for the
458 * deallocated region, payload is set to NULL.
460 void fw_core_remove_address_handler(struct fw_address_handler
*handler
)
464 spin_lock_irqsave(&address_handler_lock
, flags
);
465 list_del(&handler
->link
);
466 spin_unlock_irqrestore(&address_handler_lock
, flags
);
468 EXPORT_SYMBOL(fw_core_remove_address_handler
);
471 struct fw_packet response
;
472 u32 request_header
[4];
479 free_response_callback(struct fw_packet
*packet
,
480 struct fw_card
*card
, int status
)
482 struct fw_request
*request
;
484 request
= container_of(packet
, struct fw_request
, response
);
489 fw_fill_response(struct fw_packet
*response
, u32
*request_header
,
490 int rcode
, void *payload
, size_t length
)
492 int tcode
, tlabel
, extended_tcode
, source
, destination
;
494 tcode
= HEADER_GET_TCODE(request_header
[0]);
495 tlabel
= HEADER_GET_TLABEL(request_header
[0]);
496 source
= HEADER_GET_DESTINATION(request_header
[0]);
497 destination
= HEADER_GET_SOURCE(request_header
[1]);
498 extended_tcode
= HEADER_GET_EXTENDED_TCODE(request_header
[3]);
500 response
->header
[0] =
501 HEADER_RETRY(RETRY_1
) |
502 HEADER_TLABEL(tlabel
) |
503 HEADER_DESTINATION(destination
);
504 response
->header
[1] =
505 HEADER_SOURCE(source
) |
507 response
->header
[2] = 0;
510 case TCODE_WRITE_QUADLET_REQUEST
:
511 case TCODE_WRITE_BLOCK_REQUEST
:
512 response
->header
[0] |= HEADER_TCODE(TCODE_WRITE_RESPONSE
);
513 response
->header_length
= 12;
514 response
->payload_length
= 0;
517 case TCODE_READ_QUADLET_REQUEST
:
518 response
->header
[0] |=
519 HEADER_TCODE(TCODE_READ_QUADLET_RESPONSE
);
521 response
->header
[3] = *(u32
*)payload
;
523 response
->header
[3] = 0;
524 response
->header_length
= 16;
525 response
->payload_length
= 0;
528 case TCODE_READ_BLOCK_REQUEST
:
529 case TCODE_LOCK_REQUEST
:
530 response
->header
[0] |= HEADER_TCODE(tcode
+ 2);
531 response
->header
[3] =
532 HEADER_DATA_LENGTH(length
) |
533 HEADER_EXTENDED_TCODE(extended_tcode
);
534 response
->header_length
= 16;
535 response
->payload
= payload
;
536 response
->payload_length
= length
;
544 EXPORT_SYMBOL(fw_fill_response
);
546 static struct fw_request
*
547 allocate_request(struct fw_packet
*p
)
549 struct fw_request
*request
;
551 int request_tcode
, t
;
553 request_tcode
= HEADER_GET_TCODE(p
->header
[0]);
554 switch (request_tcode
) {
555 case TCODE_WRITE_QUADLET_REQUEST
:
556 data
= &p
->header
[3];
560 case TCODE_WRITE_BLOCK_REQUEST
:
561 case TCODE_LOCK_REQUEST
:
563 length
= HEADER_GET_DATA_LENGTH(p
->header
[3]);
566 case TCODE_READ_QUADLET_REQUEST
:
571 case TCODE_READ_BLOCK_REQUEST
:
573 length
= HEADER_GET_DATA_LENGTH(p
->header
[3]);
581 request
= kmalloc(sizeof(*request
) + length
, GFP_ATOMIC
);
585 t
= (p
->timestamp
& 0x1fff) + 4000;
587 t
= (p
->timestamp
& ~0x1fff) + 0x2000 + t
- 8000;
589 t
= (p
->timestamp
& ~0x1fff) + t
;
591 request
->response
.speed
= p
->speed
;
592 request
->response
.timestamp
= t
;
593 request
->response
.generation
= p
->generation
;
594 request
->response
.ack
= 0;
595 request
->response
.callback
= free_response_callback
;
596 request
->ack
= p
->ack
;
597 request
->length
= length
;
599 memcpy(request
->data
, data
, length
);
601 memcpy(request
->request_header
, p
->header
, sizeof(p
->header
));
607 fw_send_response(struct fw_card
*card
, struct fw_request
*request
, int rcode
)
610 * Broadcast packets are reported as ACK_COMPLETE, so this
611 * check is sufficient to ensure we don't send response to
612 * broadcast packets or posted writes.
614 if (request
->ack
!= ACK_PENDING
) {
619 if (rcode
== RCODE_COMPLETE
)
620 fw_fill_response(&request
->response
, request
->request_header
,
621 rcode
, request
->data
, request
->length
);
623 fw_fill_response(&request
->response
, request
->request_header
,
626 card
->driver
->send_response(card
, &request
->response
);
628 EXPORT_SYMBOL(fw_send_response
);
631 fw_core_handle_request(struct fw_card
*card
, struct fw_packet
*p
)
633 struct fw_address_handler
*handler
;
634 struct fw_request
*request
;
635 unsigned long long offset
;
637 int tcode
, destination
, source
;
639 if (p
->ack
!= ACK_PENDING
&& p
->ack
!= ACK_COMPLETE
)
642 request
= allocate_request(p
);
643 if (request
== NULL
) {
644 /* FIXME: send statically allocated busy packet. */
649 ((unsigned long long)
650 HEADER_GET_OFFSET_HIGH(p
->header
[1]) << 32) | p
->header
[2];
651 tcode
= HEADER_GET_TCODE(p
->header
[0]);
652 destination
= HEADER_GET_DESTINATION(p
->header
[0]);
653 source
= HEADER_GET_SOURCE(p
->header
[1]);
655 spin_lock_irqsave(&address_handler_lock
, flags
);
656 handler
= lookup_enclosing_address_handler(&address_handler_list
,
657 offset
, request
->length
);
658 spin_unlock_irqrestore(&address_handler_lock
, flags
);
661 * FIXME: lookup the fw_node corresponding to the sender of
662 * this request and pass that to the address handler instead
663 * of the node ID. We may also want to move the address
664 * allocations to fw_node so we only do this callback if the
665 * upper layers registered it for this node.
669 fw_send_response(card
, request
, RCODE_ADDRESS_ERROR
);
671 handler
->address_callback(card
, request
,
672 tcode
, destination
, source
,
673 p
->generation
, p
->speed
, offset
,
674 request
->data
, request
->length
,
675 handler
->callback_data
);
677 EXPORT_SYMBOL(fw_core_handle_request
);
680 fw_core_handle_response(struct fw_card
*card
, struct fw_packet
*p
)
682 struct fw_transaction
*t
;
686 int tcode
, tlabel
, destination
, source
, rcode
;
688 tcode
= HEADER_GET_TCODE(p
->header
[0]);
689 tlabel
= HEADER_GET_TLABEL(p
->header
[0]);
690 destination
= HEADER_GET_DESTINATION(p
->header
[0]);
691 source
= HEADER_GET_SOURCE(p
->header
[1]);
692 rcode
= HEADER_GET_RCODE(p
->header
[1]);
694 spin_lock_irqsave(&card
->lock
, flags
);
695 list_for_each_entry(t
, &card
->transaction_list
, link
) {
696 if (t
->node_id
== source
&& t
->tlabel
== tlabel
) {
698 card
->tlabel_mask
&= ~(1 << t
->tlabel
);
702 spin_unlock_irqrestore(&card
->lock
, flags
);
704 if (&t
->link
== &card
->transaction_list
) {
705 fw_notify("Unsolicited response (source %x, tlabel %x)\n",
711 * FIXME: sanity check packet, is length correct, does tcodes
712 * and addresses match.
716 case TCODE_READ_QUADLET_RESPONSE
:
717 data
= (u32
*) &p
->header
[3];
721 case TCODE_WRITE_RESPONSE
:
726 case TCODE_READ_BLOCK_RESPONSE
:
727 case TCODE_LOCK_RESPONSE
:
729 data_length
= HEADER_GET_DATA_LENGTH(p
->header
[3]);
733 /* Should never happen, this is just to shut up gcc. */
740 * The response handler may be executed while the request handler
741 * is still pending. Cancel the request handler.
743 card
->driver
->cancel_packet(card
, &t
->packet
);
745 t
->callback(card
, rcode
, data
, data_length
, t
->callback_data
);
747 EXPORT_SYMBOL(fw_core_handle_response
);
749 static const struct fw_address_region topology_map_region
=
750 { .start
= CSR_REGISTER_BASE
| CSR_TOPOLOGY_MAP
,
751 .end
= CSR_REGISTER_BASE
| CSR_TOPOLOGY_MAP_END
, };
754 handle_topology_map(struct fw_card
*card
, struct fw_request
*request
,
755 int tcode
, int destination
, int source
,
756 int generation
, int speed
,
757 unsigned long long offset
,
758 void *payload
, size_t length
, void *callback_data
)
763 if (!TCODE_IS_READ_REQUEST(tcode
)) {
764 fw_send_response(card
, request
, RCODE_TYPE_ERROR
);
768 if ((offset
& 3) > 0 || (length
& 3) > 0) {
769 fw_send_response(card
, request
, RCODE_ADDRESS_ERROR
);
773 start
= (offset
- topology_map_region
.start
) / 4;
774 end
= start
+ length
/ 4;
777 for (i
= 0; i
< length
/ 4; i
++)
778 map
[i
] = cpu_to_be32(card
->topology_map
[start
+ i
]);
780 fw_send_response(card
, request
, RCODE_COMPLETE
);
783 static struct fw_address_handler topology_map
= {
785 .address_callback
= handle_topology_map
,
788 static const struct fw_address_region registers_region
=
789 { .start
= CSR_REGISTER_BASE
,
790 .end
= CSR_REGISTER_BASE
| CSR_CONFIG_ROM
, };
793 handle_registers(struct fw_card
*card
, struct fw_request
*request
,
794 int tcode
, int destination
, int source
,
795 int generation
, int speed
,
796 unsigned long long offset
,
797 void *payload
, size_t length
, void *callback_data
)
799 int reg
= offset
& ~CSR_REGISTER_BASE
;
800 unsigned long long bus_time
;
801 __be32
*data
= payload
;
806 if (!TCODE_IS_READ_REQUEST(tcode
) || length
!= 4) {
807 fw_send_response(card
, request
, RCODE_TYPE_ERROR
);
811 bus_time
= card
->driver
->get_bus_time(card
);
812 if (reg
== CSR_CYCLE_TIME
)
813 *data
= cpu_to_be32(bus_time
);
815 *data
= cpu_to_be32(bus_time
>> 25);
816 fw_send_response(card
, request
, RCODE_COMPLETE
);
819 case CSR_BUS_MANAGER_ID
:
820 case CSR_BANDWIDTH_AVAILABLE
:
821 case CSR_CHANNELS_AVAILABLE_HI
:
822 case CSR_CHANNELS_AVAILABLE_LO
:
824 * FIXME: these are handled by the OHCI hardware and
825 * the stack never sees these request. If we add
826 * support for a new type of controller that doesn't
827 * handle this in hardware we need to deal with these
833 case CSR_BUSY_TIMEOUT
:
834 /* FIXME: Implement this. */
836 fw_send_response(card
, request
, RCODE_ADDRESS_ERROR
);
841 static struct fw_address_handler registers
= {
843 .address_callback
= handle_registers
,
846 MODULE_AUTHOR("Kristian Hoegsberg <krh@bitplanet.net>");
847 MODULE_DESCRIPTION("Core IEEE1394 transaction logic");
848 MODULE_LICENSE("GPL");
850 static const u32 vendor_textual_descriptor
[] = {
851 /* textual descriptor leaf () */
855 0x4c696e75, /* L i n u */
856 0x78204669, /* x F i */
857 0x72657769, /* r e w i */
858 0x72650000, /* r e */
861 static const u32 model_textual_descriptor
[] = {
862 /* model descriptor leaf () */
866 0x4a756a75, /* J u j u */
869 static struct fw_descriptor vendor_id_descriptor
= {
870 .length
= ARRAY_SIZE(vendor_textual_descriptor
),
871 .immediate
= 0x03d00d1e,
873 .data
= vendor_textual_descriptor
,
876 static struct fw_descriptor model_id_descriptor
= {
877 .length
= ARRAY_SIZE(model_textual_descriptor
),
878 .immediate
= 0x17000001,
880 .data
= model_textual_descriptor
,
883 static int __init
fw_core_init(void)
887 retval
= bus_register(&fw_bus_type
);
891 fw_cdev_major
= register_chrdev(0, "firewire", &fw_device_ops
);
892 if (fw_cdev_major
< 0) {
893 bus_unregister(&fw_bus_type
);
894 return fw_cdev_major
;
897 retval
= fw_core_add_address_handler(&topology_map
,
898 &topology_map_region
);
901 retval
= fw_core_add_address_handler(®isters
,
905 /* Add the vendor textual descriptor. */
906 retval
= fw_core_add_descriptor(&vendor_id_descriptor
);
908 retval
= fw_core_add_descriptor(&model_id_descriptor
);
914 static void __exit
fw_core_cleanup(void)
916 unregister_chrdev(fw_cdev_major
, "firewire");
917 bus_unregister(&fw_bus_type
);
920 module_init(fw_core_init
);
921 module_exit(fw_core_cleanup
);