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/idr.h>
23 #include <linux/kernel.h>
24 #include <linux/kref.h>
25 #include <linux/module.h>
26 #include <linux/mutex.h>
27 #include <linux/init.h>
28 #include <linux/interrupt.h>
29 #include <linux/pci.h>
30 #include <linux/delay.h>
31 #include <linux/poll.h>
32 #include <linux/list.h>
33 #include <linux/kthread.h>
34 #include <asm/uaccess.h>
36 #include "fw-transaction.h"
37 #include "fw-topology.h"
38 #include "fw-device.h"
40 #define HEADER_PRI(pri) ((pri) << 0)
41 #define HEADER_TCODE(tcode) ((tcode) << 4)
42 #define HEADER_RETRY(retry) ((retry) << 8)
43 #define HEADER_TLABEL(tlabel) ((tlabel) << 10)
44 #define HEADER_DESTINATION(destination) ((destination) << 16)
45 #define HEADER_SOURCE(source) ((source) << 16)
46 #define HEADER_RCODE(rcode) ((rcode) << 12)
47 #define HEADER_OFFSET_HIGH(offset_high) ((offset_high) << 0)
48 #define HEADER_DATA_LENGTH(length) ((length) << 16)
49 #define HEADER_EXTENDED_TCODE(tcode) ((tcode) << 0)
51 #define HEADER_GET_TCODE(q) (((q) >> 4) & 0x0f)
52 #define HEADER_GET_TLABEL(q) (((q) >> 10) & 0x3f)
53 #define HEADER_GET_RCODE(q) (((q) >> 12) & 0x0f)
54 #define HEADER_GET_DESTINATION(q) (((q) >> 16) & 0xffff)
55 #define HEADER_GET_SOURCE(q) (((q) >> 16) & 0xffff)
56 #define HEADER_GET_OFFSET_HIGH(q) (((q) >> 0) & 0xffff)
57 #define HEADER_GET_DATA_LENGTH(q) (((q) >> 16) & 0xffff)
58 #define HEADER_GET_EXTENDED_TCODE(q) (((q) >> 0) & 0xffff)
60 #define HEADER_DESTINATION_IS_BROADCAST(q) \
61 (((q) & HEADER_DESTINATION(0x3f)) == HEADER_DESTINATION(0x3f))
63 #define PHY_CONFIG_GAP_COUNT(gap_count) (((gap_count) << 16) | (1 << 22))
64 #define PHY_CONFIG_ROOT_ID(node_id) ((((node_id) & 0x3f) << 24) | (1 << 23))
65 #define PHY_IDENTIFIER(id) ((id) << 30)
68 close_transaction(struct fw_transaction
*transaction
,
69 struct fw_card
*card
, int rcode
,
70 u32
*payload
, size_t length
)
72 struct fw_transaction
*t
;
75 spin_lock_irqsave(&card
->lock
, flags
);
76 list_for_each_entry(t
, &card
->transaction_list
, link
) {
77 if (t
== transaction
) {
79 card
->tlabel_mask
&= ~(1 << t
->tlabel
);
83 spin_unlock_irqrestore(&card
->lock
, flags
);
85 if (&t
->link
!= &card
->transaction_list
) {
86 t
->callback(card
, rcode
, payload
, length
, t
->callback_data
);
94 * Only valid for transactions that are potentially pending (ie have
98 fw_cancel_transaction(struct fw_card
*card
,
99 struct fw_transaction
*transaction
)
102 * Cancel the packet transmission if it's still queued. That
103 * will call the packet transmission callback which cancels
107 if (card
->driver
->cancel_packet(card
, &transaction
->packet
) == 0)
111 * If the request packet has already been sent, we need to see
112 * if the transaction is still pending and remove it in that case.
115 return close_transaction(transaction
, card
, RCODE_CANCELLED
, NULL
, 0);
117 EXPORT_SYMBOL(fw_cancel_transaction
);
120 transmit_complete_callback(struct fw_packet
*packet
,
121 struct fw_card
*card
, int status
)
123 struct fw_transaction
*t
=
124 container_of(packet
, struct fw_transaction
, packet
);
128 close_transaction(t
, card
, RCODE_COMPLETE
, NULL
, 0);
131 t
->timestamp
= packet
->timestamp
;
136 close_transaction(t
, card
, RCODE_BUSY
, NULL
, 0);
139 close_transaction(t
, card
, RCODE_DATA_ERROR
, NULL
, 0);
142 close_transaction(t
, card
, RCODE_TYPE_ERROR
, NULL
, 0);
146 * In this case the ack is really a juju specific
147 * rcode, so just forward that to the callback.
149 close_transaction(t
, card
, status
, NULL
, 0);
155 fw_fill_request(struct fw_packet
*packet
, int tcode
, int tlabel
,
156 int destination_id
, int source_id
, int generation
, int speed
,
157 unsigned long long offset
, void *payload
, size_t length
)
162 ext_tcode
= tcode
& ~0x10;
163 tcode
= TCODE_LOCK_REQUEST
;
168 HEADER_RETRY(RETRY_X
) |
169 HEADER_TLABEL(tlabel
) |
170 HEADER_TCODE(tcode
) |
171 HEADER_DESTINATION(destination_id
);
173 HEADER_OFFSET_HIGH(offset
>> 32) | HEADER_SOURCE(source_id
);
178 case TCODE_WRITE_QUADLET_REQUEST
:
179 packet
->header
[3] = *(u32
*)payload
;
180 packet
->header_length
= 16;
181 packet
->payload_length
= 0;
184 case TCODE_LOCK_REQUEST
:
185 case TCODE_WRITE_BLOCK_REQUEST
:
187 HEADER_DATA_LENGTH(length
) |
188 HEADER_EXTENDED_TCODE(ext_tcode
);
189 packet
->header_length
= 16;
190 packet
->payload
= payload
;
191 packet
->payload_length
= length
;
194 case TCODE_READ_QUADLET_REQUEST
:
195 packet
->header_length
= 12;
196 packet
->payload_length
= 0;
199 case TCODE_READ_BLOCK_REQUEST
:
201 HEADER_DATA_LENGTH(length
) |
202 HEADER_EXTENDED_TCODE(ext_tcode
);
203 packet
->header_length
= 16;
204 packet
->payload_length
= 0;
208 packet
->speed
= speed
;
209 packet
->generation
= generation
;
211 packet
->payload_bus
= 0;
215 * This function provides low-level access to the IEEE1394 transaction
216 * logic. Most C programs would use either fw_read(), fw_write() or
217 * fw_lock() instead - those function are convenience wrappers for
218 * this function. The fw_send_request() function is primarily
219 * provided as a flexible, one-stop entry point for languages bindings
220 * and protocol bindings.
222 * FIXME: Document this function further, in particular the possible
223 * values for rcode in the callback. In short, we map ACK_COMPLETE to
224 * RCODE_COMPLETE, internal errors set errno and set rcode to
225 * RCODE_SEND_ERROR (which is out of range for standard ieee1394
226 * rcodes). All other rcodes are forwarded unchanged. For all
227 * errors, payload is NULL, length is 0.
229 * Can not expect the callback to be called before the function
230 * returns, though this does happen in some cases (ACK_COMPLETE and
233 * The payload is only used for write requests and must not be freed
234 * until the callback has been called.
236 * @param card the card from which to send the request
237 * @param tcode the tcode for this transaction. Do not use
238 * TCODE_LOCK_REQUEST directly, instead use TCODE_LOCK_MASK_SWAP
239 * etc. to specify tcode and ext_tcode.
240 * @param node_id the destination node ID (bus ID and PHY ID concatenated)
241 * @param generation the generation for which node_id is valid
242 * @param speed the speed to use for sending the request
243 * @param offset the 48 bit offset on the destination node
244 * @param payload the data payload for the request subaction
245 * @param length the length in bytes of the data to read
246 * @param callback function to be called when the transaction is completed
247 * @param callback_data pointer to arbitrary data, which will be
248 * passed to the callback
251 fw_send_request(struct fw_card
*card
, struct fw_transaction
*t
,
252 int tcode
, int destination_id
, int generation
, int speed
,
253 unsigned long long offset
,
254 void *payload
, size_t length
,
255 fw_transaction_callback_t callback
, void *callback_data
)
261 * Bump the flush timer up 100ms first of all so we
262 * don't race with a flush timer callback.
265 mod_timer(&card
->flush_timer
, jiffies
+ DIV_ROUND_UP(HZ
, 10));
268 * Allocate tlabel from the bitmap and put the transaction on
269 * the list while holding the card spinlock.
272 spin_lock_irqsave(&card
->lock
, flags
);
274 tlabel
= card
->current_tlabel
;
275 if (card
->tlabel_mask
& (1 << tlabel
)) {
276 spin_unlock_irqrestore(&card
->lock
, flags
);
277 callback(card
, RCODE_SEND_ERROR
, NULL
, 0, callback_data
);
281 card
->current_tlabel
= (card
->current_tlabel
+ 1) & 0x1f;
282 card
->tlabel_mask
|= (1 << tlabel
);
284 t
->node_id
= destination_id
;
286 t
->callback
= callback
;
287 t
->callback_data
= callback_data
;
289 fw_fill_request(&t
->packet
, tcode
, t
->tlabel
,
290 destination_id
, card
->node_id
, generation
,
291 speed
, offset
, payload
, length
);
292 t
->packet
.callback
= transmit_complete_callback
;
294 list_add_tail(&t
->link
, &card
->transaction_list
);
296 spin_unlock_irqrestore(&card
->lock
, flags
);
298 card
->driver
->send_request(card
, &t
->packet
);
300 EXPORT_SYMBOL(fw_send_request
);
302 struct transaction_callback_data
{
303 struct completion done
;
308 static void transaction_callback(struct fw_card
*card
, int rcode
,
309 void *payload
, size_t length
, void *data
)
311 struct transaction_callback_data
*d
= data
;
313 if (rcode
== RCODE_COMPLETE
)
314 memcpy(d
->payload
, payload
, length
);
320 * fw_run_transaction - send request and sleep until transaction is completed
324 int fw_run_transaction(struct fw_card
*card
, int tcode
, int destination_id
,
325 int generation
, int speed
, unsigned long long offset
,
326 void *data
, size_t length
)
328 struct transaction_callback_data d
;
329 struct fw_transaction t
;
331 init_completion(&d
.done
);
333 fw_send_request(card
, &t
, tcode
, destination_id
, generation
, speed
,
334 offset
, data
, length
, transaction_callback
, &d
);
335 wait_for_completion(&d
.done
);
339 EXPORT_SYMBOL(fw_run_transaction
);
341 static DEFINE_MUTEX(phy_config_mutex
);
342 static DECLARE_COMPLETION(phy_config_done
);
344 static void transmit_phy_packet_callback(struct fw_packet
*packet
,
345 struct fw_card
*card
, int status
)
347 complete(&phy_config_done
);
350 static struct fw_packet phy_config_packet
= {
354 .callback
= transmit_phy_packet_callback
,
357 void fw_send_phy_config(struct fw_card
*card
,
358 int node_id
, int generation
, int gap_count
)
360 long timeout
= DIV_ROUND_UP(HZ
, 10);
361 u32 data
= PHY_IDENTIFIER(PHY_PACKET_CONFIG
) |
362 PHY_CONFIG_ROOT_ID(node_id
) |
363 PHY_CONFIG_GAP_COUNT(gap_count
);
365 mutex_lock(&phy_config_mutex
);
367 phy_config_packet
.header
[0] = data
;
368 phy_config_packet
.header
[1] = ~data
;
369 phy_config_packet
.generation
= generation
;
370 INIT_COMPLETION(phy_config_done
);
372 card
->driver
->send_request(card
, &phy_config_packet
);
373 wait_for_completion_timeout(&phy_config_done
, timeout
);
375 mutex_unlock(&phy_config_mutex
);
378 void fw_flush_transactions(struct fw_card
*card
)
380 struct fw_transaction
*t
, *next
;
381 struct list_head list
;
384 INIT_LIST_HEAD(&list
);
385 spin_lock_irqsave(&card
->lock
, flags
);
386 list_splice_init(&card
->transaction_list
, &list
);
387 card
->tlabel_mask
= 0;
388 spin_unlock_irqrestore(&card
->lock
, flags
);
390 list_for_each_entry_safe(t
, next
, &list
, link
) {
391 card
->driver
->cancel_packet(card
, &t
->packet
);
394 * At this point cancel_packet will never call the
395 * transaction callback, since we just took all the
396 * transactions out of the list. So do it here.
398 t
->callback(card
, RCODE_CANCELLED
, NULL
, 0, t
->callback_data
);
402 static struct fw_address_handler
*
403 lookup_overlapping_address_handler(struct list_head
*list
,
404 unsigned long long offset
, size_t length
)
406 struct fw_address_handler
*handler
;
408 list_for_each_entry(handler
, list
, link
) {
409 if (handler
->offset
< offset
+ length
&&
410 offset
< handler
->offset
+ handler
->length
)
417 static struct fw_address_handler
*
418 lookup_enclosing_address_handler(struct list_head
*list
,
419 unsigned long long offset
, size_t length
)
421 struct fw_address_handler
*handler
;
423 list_for_each_entry(handler
, list
, link
) {
424 if (handler
->offset
<= offset
&&
425 offset
+ length
<= handler
->offset
+ handler
->length
)
432 static DEFINE_SPINLOCK(address_handler_lock
);
433 static LIST_HEAD(address_handler_list
);
435 const struct fw_address_region fw_high_memory_region
=
436 { .start
= 0x000100000000ULL
, .end
= 0xffffe0000000ULL
, };
437 EXPORT_SYMBOL(fw_high_memory_region
);
440 const struct fw_address_region fw_low_memory_region
=
441 { .start
= 0x000000000000ULL
, .end
= 0x000100000000ULL
, };
442 const struct fw_address_region fw_private_region
=
443 { .start
= 0xffffe0000000ULL
, .end
= 0xfffff0000000ULL
, };
444 const struct fw_address_region fw_csr_region
=
445 { .start
= CSR_REGISTER_BASE
,
446 .end
= CSR_REGISTER_BASE
| CSR_CONFIG_ROM_END
, };
447 const struct fw_address_region fw_unit_space_region
=
448 { .start
= 0xfffff0000900ULL
, .end
= 0x1000000000000ULL
, };
452 * fw_core_add_address_handler - register for incoming requests
454 * @region: region in the IEEE 1212 node space address range
456 * region->start, ->end, and handler->length have to be quadlet-aligned.
458 * When a request is received that falls within the specified address range,
459 * the specified callback is invoked. The parameters passed to the callback
460 * give the details of the particular request.
462 * Return value: 0 on success, non-zero otherwise.
463 * The start offset of the handler's address region is determined by
464 * fw_core_add_address_handler() and is returned in handler->offset.
467 fw_core_add_address_handler(struct fw_address_handler
*handler
,
468 const struct fw_address_region
*region
)
470 struct fw_address_handler
*other
;
474 if (region
->start
& 0xffff000000000003ULL
||
475 region
->end
& 0xffff000000000003ULL
||
476 region
->start
>= region
->end
||
477 handler
->length
& 3 ||
478 handler
->length
== 0)
481 spin_lock_irqsave(&address_handler_lock
, flags
);
483 handler
->offset
= region
->start
;
484 while (handler
->offset
+ handler
->length
<= region
->end
) {
486 lookup_overlapping_address_handler(&address_handler_list
,
490 handler
->offset
+= other
->length
;
492 list_add_tail(&handler
->link
, &address_handler_list
);
498 spin_unlock_irqrestore(&address_handler_lock
, flags
);
502 EXPORT_SYMBOL(fw_core_add_address_handler
);
505 * fw_core_remove_address_handler - unregister an address handler
507 void fw_core_remove_address_handler(struct fw_address_handler
*handler
)
511 spin_lock_irqsave(&address_handler_lock
, flags
);
512 list_del(&handler
->link
);
513 spin_unlock_irqrestore(&address_handler_lock
, flags
);
515 EXPORT_SYMBOL(fw_core_remove_address_handler
);
518 struct fw_packet response
;
519 u32 request_header
[4];
526 free_response_callback(struct fw_packet
*packet
,
527 struct fw_card
*card
, int status
)
529 struct fw_request
*request
;
531 request
= container_of(packet
, struct fw_request
, response
);
536 fw_fill_response(struct fw_packet
*response
, u32
*request_header
,
537 int rcode
, void *payload
, size_t length
)
539 int tcode
, tlabel
, extended_tcode
, source
, destination
;
541 tcode
= HEADER_GET_TCODE(request_header
[0]);
542 tlabel
= HEADER_GET_TLABEL(request_header
[0]);
543 source
= HEADER_GET_DESTINATION(request_header
[0]);
544 destination
= HEADER_GET_SOURCE(request_header
[1]);
545 extended_tcode
= HEADER_GET_EXTENDED_TCODE(request_header
[3]);
547 response
->header
[0] =
548 HEADER_RETRY(RETRY_1
) |
549 HEADER_TLABEL(tlabel
) |
550 HEADER_DESTINATION(destination
);
551 response
->header
[1] =
552 HEADER_SOURCE(source
) |
554 response
->header
[2] = 0;
557 case TCODE_WRITE_QUADLET_REQUEST
:
558 case TCODE_WRITE_BLOCK_REQUEST
:
559 response
->header
[0] |= HEADER_TCODE(TCODE_WRITE_RESPONSE
);
560 response
->header_length
= 12;
561 response
->payload_length
= 0;
564 case TCODE_READ_QUADLET_REQUEST
:
565 response
->header
[0] |=
566 HEADER_TCODE(TCODE_READ_QUADLET_RESPONSE
);
568 response
->header
[3] = *(u32
*)payload
;
570 response
->header
[3] = 0;
571 response
->header_length
= 16;
572 response
->payload_length
= 0;
575 case TCODE_READ_BLOCK_REQUEST
:
576 case TCODE_LOCK_REQUEST
:
577 response
->header
[0] |= HEADER_TCODE(tcode
+ 2);
578 response
->header
[3] =
579 HEADER_DATA_LENGTH(length
) |
580 HEADER_EXTENDED_TCODE(extended_tcode
);
581 response
->header_length
= 16;
582 response
->payload
= payload
;
583 response
->payload_length
= length
;
591 response
->payload_bus
= 0;
593 EXPORT_SYMBOL(fw_fill_response
);
595 static struct fw_request
*
596 allocate_request(struct fw_packet
*p
)
598 struct fw_request
*request
;
600 int request_tcode
, t
;
602 request_tcode
= HEADER_GET_TCODE(p
->header
[0]);
603 switch (request_tcode
) {
604 case TCODE_WRITE_QUADLET_REQUEST
:
605 data
= &p
->header
[3];
609 case TCODE_WRITE_BLOCK_REQUEST
:
610 case TCODE_LOCK_REQUEST
:
612 length
= HEADER_GET_DATA_LENGTH(p
->header
[3]);
615 case TCODE_READ_QUADLET_REQUEST
:
620 case TCODE_READ_BLOCK_REQUEST
:
622 length
= HEADER_GET_DATA_LENGTH(p
->header
[3]);
626 fw_error("ERROR - corrupt request received - %08x %08x %08x\n",
627 p
->header
[0], p
->header
[1], p
->header
[2]);
631 request
= kmalloc(sizeof(*request
) + length
, GFP_ATOMIC
);
635 t
= (p
->timestamp
& 0x1fff) + 4000;
637 t
= (p
->timestamp
& ~0x1fff) + 0x2000 + t
- 8000;
639 t
= (p
->timestamp
& ~0x1fff) + t
;
641 request
->response
.speed
= p
->speed
;
642 request
->response
.timestamp
= t
;
643 request
->response
.generation
= p
->generation
;
644 request
->response
.ack
= 0;
645 request
->response
.callback
= free_response_callback
;
646 request
->ack
= p
->ack
;
647 request
->length
= length
;
649 memcpy(request
->data
, data
, length
);
651 memcpy(request
->request_header
, p
->header
, sizeof(p
->header
));
657 fw_send_response(struct fw_card
*card
, struct fw_request
*request
, int rcode
)
659 /* unified transaction or broadcast transaction: don't respond */
660 if (request
->ack
!= ACK_PENDING
||
661 HEADER_DESTINATION_IS_BROADCAST(request
->request_header
[0])) {
666 if (rcode
== RCODE_COMPLETE
)
667 fw_fill_response(&request
->response
, request
->request_header
,
668 rcode
, request
->data
, request
->length
);
670 fw_fill_response(&request
->response
, request
->request_header
,
673 card
->driver
->send_response(card
, &request
->response
);
675 EXPORT_SYMBOL(fw_send_response
);
678 fw_core_handle_request(struct fw_card
*card
, struct fw_packet
*p
)
680 struct fw_address_handler
*handler
;
681 struct fw_request
*request
;
682 unsigned long long offset
;
684 int tcode
, destination
, source
;
686 if (p
->ack
!= ACK_PENDING
&& p
->ack
!= ACK_COMPLETE
)
689 request
= allocate_request(p
);
690 if (request
== NULL
) {
691 /* FIXME: send statically allocated busy packet. */
696 ((unsigned long long)
697 HEADER_GET_OFFSET_HIGH(p
->header
[1]) << 32) | p
->header
[2];
698 tcode
= HEADER_GET_TCODE(p
->header
[0]);
699 destination
= HEADER_GET_DESTINATION(p
->header
[0]);
700 source
= HEADER_GET_SOURCE(p
->header
[1]);
702 spin_lock_irqsave(&address_handler_lock
, flags
);
703 handler
= lookup_enclosing_address_handler(&address_handler_list
,
704 offset
, request
->length
);
705 spin_unlock_irqrestore(&address_handler_lock
, flags
);
708 * FIXME: lookup the fw_node corresponding to the sender of
709 * this request and pass that to the address handler instead
710 * of the node ID. We may also want to move the address
711 * allocations to fw_node so we only do this callback if the
712 * upper layers registered it for this node.
716 fw_send_response(card
, request
, RCODE_ADDRESS_ERROR
);
718 handler
->address_callback(card
, request
,
719 tcode
, destination
, source
,
720 p
->generation
, p
->speed
, offset
,
721 request
->data
, request
->length
,
722 handler
->callback_data
);
724 EXPORT_SYMBOL(fw_core_handle_request
);
727 fw_core_handle_response(struct fw_card
*card
, struct fw_packet
*p
)
729 struct fw_transaction
*t
;
733 int tcode
, tlabel
, destination
, source
, rcode
;
735 tcode
= HEADER_GET_TCODE(p
->header
[0]);
736 tlabel
= HEADER_GET_TLABEL(p
->header
[0]);
737 destination
= HEADER_GET_DESTINATION(p
->header
[0]);
738 source
= HEADER_GET_SOURCE(p
->header
[1]);
739 rcode
= HEADER_GET_RCODE(p
->header
[1]);
741 spin_lock_irqsave(&card
->lock
, flags
);
742 list_for_each_entry(t
, &card
->transaction_list
, link
) {
743 if (t
->node_id
== source
&& t
->tlabel
== tlabel
) {
745 card
->tlabel_mask
&= ~(1 << t
->tlabel
);
749 spin_unlock_irqrestore(&card
->lock
, flags
);
751 if (&t
->link
== &card
->transaction_list
) {
752 fw_notify("Unsolicited response (source %x, tlabel %x)\n",
758 * FIXME: sanity check packet, is length correct, does tcodes
759 * and addresses match.
763 case TCODE_READ_QUADLET_RESPONSE
:
764 data
= (u32
*) &p
->header
[3];
768 case TCODE_WRITE_RESPONSE
:
773 case TCODE_READ_BLOCK_RESPONSE
:
774 case TCODE_LOCK_RESPONSE
:
776 data_length
= HEADER_GET_DATA_LENGTH(p
->header
[3]);
780 /* Should never happen, this is just to shut up gcc. */
787 * The response handler may be executed while the request handler
788 * is still pending. Cancel the request handler.
790 card
->driver
->cancel_packet(card
, &t
->packet
);
792 t
->callback(card
, rcode
, data
, data_length
, t
->callback_data
);
794 EXPORT_SYMBOL(fw_core_handle_response
);
796 static const struct fw_address_region topology_map_region
=
797 { .start
= CSR_REGISTER_BASE
| CSR_TOPOLOGY_MAP
,
798 .end
= CSR_REGISTER_BASE
| CSR_TOPOLOGY_MAP_END
, };
801 handle_topology_map(struct fw_card
*card
, struct fw_request
*request
,
802 int tcode
, int destination
, int source
,
803 int generation
, int speed
,
804 unsigned long long offset
,
805 void *payload
, size_t length
, void *callback_data
)
810 if (!TCODE_IS_READ_REQUEST(tcode
)) {
811 fw_send_response(card
, request
, RCODE_TYPE_ERROR
);
815 if ((offset
& 3) > 0 || (length
& 3) > 0) {
816 fw_send_response(card
, request
, RCODE_ADDRESS_ERROR
);
820 start
= (offset
- topology_map_region
.start
) / 4;
821 end
= start
+ length
/ 4;
824 for (i
= 0; i
< length
/ 4; i
++)
825 map
[i
] = cpu_to_be32(card
->topology_map
[start
+ i
]);
827 fw_send_response(card
, request
, RCODE_COMPLETE
);
830 static struct fw_address_handler topology_map
= {
832 .address_callback
= handle_topology_map
,
835 static const struct fw_address_region registers_region
=
836 { .start
= CSR_REGISTER_BASE
,
837 .end
= CSR_REGISTER_BASE
| CSR_CONFIG_ROM
, };
840 handle_registers(struct fw_card
*card
, struct fw_request
*request
,
841 int tcode
, int destination
, int source
,
842 int generation
, int speed
,
843 unsigned long long offset
,
844 void *payload
, size_t length
, void *callback_data
)
846 int reg
= offset
& ~CSR_REGISTER_BASE
;
847 unsigned long long bus_time
;
848 __be32
*data
= payload
;
849 int rcode
= RCODE_COMPLETE
;
854 if (!TCODE_IS_READ_REQUEST(tcode
) || length
!= 4) {
855 rcode
= RCODE_TYPE_ERROR
;
859 bus_time
= card
->driver
->get_bus_time(card
);
860 if (reg
== CSR_CYCLE_TIME
)
861 *data
= cpu_to_be32(bus_time
);
863 *data
= cpu_to_be32(bus_time
>> 25);
866 case CSR_BROADCAST_CHANNEL
:
867 if (tcode
== TCODE_READ_QUADLET_REQUEST
)
868 *data
= cpu_to_be32(card
->broadcast_channel
);
869 else if (tcode
== TCODE_WRITE_QUADLET_REQUEST
)
870 card
->broadcast_channel
=
871 (be32_to_cpu(*data
) & BROADCAST_CHANNEL_VALID
) |
872 BROADCAST_CHANNEL_INITIAL
;
874 rcode
= RCODE_TYPE_ERROR
;
877 case CSR_BUS_MANAGER_ID
:
878 case CSR_BANDWIDTH_AVAILABLE
:
879 case CSR_CHANNELS_AVAILABLE_HI
:
880 case CSR_CHANNELS_AVAILABLE_LO
:
882 * FIXME: these are handled by the OHCI hardware and
883 * the stack never sees these request. If we add
884 * support for a new type of controller that doesn't
885 * handle this in hardware we need to deal with these
891 case CSR_BUSY_TIMEOUT
:
892 /* FIXME: Implement this. */
895 rcode
= RCODE_ADDRESS_ERROR
;
899 fw_send_response(card
, request
, rcode
);
902 static struct fw_address_handler registers
= {
904 .address_callback
= handle_registers
,
907 MODULE_AUTHOR("Kristian Hoegsberg <krh@bitplanet.net>");
908 MODULE_DESCRIPTION("Core IEEE1394 transaction logic");
909 MODULE_LICENSE("GPL");
911 static const u32 vendor_textual_descriptor
[] = {
912 /* textual descriptor leaf () */
916 0x4c696e75, /* L i n u */
917 0x78204669, /* x F i */
918 0x72657769, /* r e w i */
919 0x72650000, /* r e */
922 static const u32 model_textual_descriptor
[] = {
923 /* model descriptor leaf () */
927 0x4a756a75, /* J u j u */
930 static struct fw_descriptor vendor_id_descriptor
= {
931 .length
= ARRAY_SIZE(vendor_textual_descriptor
),
932 .immediate
= 0x03d00d1e,
934 .data
= vendor_textual_descriptor
,
937 static struct fw_descriptor model_id_descriptor
= {
938 .length
= ARRAY_SIZE(model_textual_descriptor
),
939 .immediate
= 0x17000001,
941 .data
= model_textual_descriptor
,
944 static int __init
fw_core_init(void)
948 ret
= bus_register(&fw_bus_type
);
952 fw_cdev_major
= register_chrdev(0, "firewire", &fw_device_ops
);
953 if (fw_cdev_major
< 0) {
954 bus_unregister(&fw_bus_type
);
955 return fw_cdev_major
;
958 fw_core_add_address_handler(&topology_map
, &topology_map_region
);
959 fw_core_add_address_handler(®isters
, ®isters_region
);
960 fw_core_add_descriptor(&vendor_id_descriptor
);
961 fw_core_add_descriptor(&model_id_descriptor
);
966 static void __exit
fw_core_cleanup(void)
968 unregister_chrdev(fw_cdev_major
, "firewire");
969 bus_unregister(&fw_bus_type
);
970 idr_destroy(&fw_device_idr
);
973 module_init(fw_core_init
);
974 module_exit(fw_core_cleanup
);