123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398 |
- #include <linux/device.h>
- #include <linux/firewire.h>
- #include <linux/firewire-constants.h>
- #include <linux/list.h>
- #include <linux/module.h>
- #include <linux/slab.h>
- #include <linux/sched.h>
- #include <linux/spinlock.h>
- #include <linux/wait.h>
- #include <linux/delay.h>
- #include "fcp.h"
- #include "lib.h"
- #include "amdtp.h"
- #define CTS_AVC 0x00
- #define ERROR_RETRIES 3
- #define ERROR_DELAY_MS 5
- #define FCP_TIMEOUT_MS 125
- int avc_general_set_sig_fmt(struct fw_unit *unit, unsigned int rate,
- enum avc_general_plug_dir dir,
- unsigned short pid)
- {
- unsigned int sfc;
- u8 *buf;
- bool flag;
- int err;
- flag = false;
- for (sfc = 0; sfc < CIP_SFC_COUNT; sfc++) {
- if (amdtp_rate_table[sfc] == rate) {
- flag = true;
- break;
- }
- }
- if (!flag)
- return -EINVAL;
- buf = kzalloc(8, GFP_KERNEL);
- if (buf == NULL)
- return -ENOMEM;
- buf[0] = 0x00;
- buf[1] = 0xff;
- if (dir == AVC_GENERAL_PLUG_DIR_IN)
- buf[2] = 0x19;
- else
- buf[2] = 0x18;
- buf[3] = 0xff & pid;
- buf[4] = 0x90;
- buf[5] = 0x07 & sfc;
- buf[6] = 0xff;
- buf[7] = 0xff;
-
- err = fcp_avc_transaction(unit, buf, 8, buf, 8,
- BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5));
- if (err >= 0 && err < 8)
- err = -EIO;
- else if (buf[0] == 0x08)
- err = -ENOSYS;
- else if (buf[0] == 0x0a)
- err = -EINVAL;
- if (err < 0)
- goto end;
- err = 0;
- end:
- kfree(buf);
- return err;
- }
- EXPORT_SYMBOL(avc_general_set_sig_fmt);
- int avc_general_get_sig_fmt(struct fw_unit *unit, unsigned int *rate,
- enum avc_general_plug_dir dir,
- unsigned short pid)
- {
- unsigned int sfc;
- u8 *buf;
- int err;
- buf = kzalloc(8, GFP_KERNEL);
- if (buf == NULL)
- return -ENOMEM;
- buf[0] = 0x01;
- buf[1] = 0xff;
- if (dir == AVC_GENERAL_PLUG_DIR_IN)
- buf[2] = 0x19;
- else
- buf[2] = 0x18;
- buf[3] = 0xff & pid;
- buf[4] = 0x90;
- buf[5] = 0xff;
- buf[6] = 0xff;
- buf[7] = 0xff;
-
- err = fcp_avc_transaction(unit, buf, 8, buf, 8,
- BIT(1) | BIT(2) | BIT(3) | BIT(4));
- if (err >= 0 && err < 8)
- err = -EIO;
- else if (buf[0] == 0x08)
- err = -ENOSYS;
- else if (buf[0] == 0x0a)
- err = -EINVAL;
- else if (buf[0] == 0x0b)
- err = -EAGAIN;
- if (err < 0)
- goto end;
-
- sfc = 0x07 & buf[5];
- if (sfc >= CIP_SFC_COUNT) {
- err = -EAGAIN;
- goto end;
- }
- *rate = amdtp_rate_table[sfc];
- err = 0;
- end:
- kfree(buf);
- return err;
- }
- EXPORT_SYMBOL(avc_general_get_sig_fmt);
- int avc_general_get_plug_info(struct fw_unit *unit, unsigned int subunit_type,
- unsigned int subunit_id, unsigned int subfunction,
- u8 info[AVC_PLUG_INFO_BUF_BYTES])
- {
- u8 *buf;
- int err;
-
- if ((subunit_type == 0x1E) || (subunit_id == 5))
- return -EINVAL;
- buf = kzalloc(8, GFP_KERNEL);
- if (buf == NULL)
- return -ENOMEM;
- buf[0] = 0x01;
-
- buf[1] = ((subunit_type & 0x1f) << 3) | (subunit_id & 0x7);
- buf[2] = 0x02;
- buf[3] = 0xff & subfunction;
- err = fcp_avc_transaction(unit, buf, 8, buf, 8, BIT(1) | BIT(2));
- if (err >= 0 && err < 8)
- err = -EIO;
- else if (buf[0] == 0x08)
- err = -ENOSYS;
- else if (buf[0] == 0x0a)
- err = -EINVAL;
- else if (buf[0] == 0x0b)
- err = -EAGAIN;
- if (err < 0)
- goto end;
- info[0] = buf[4];
- info[1] = buf[5];
- info[2] = buf[6];
- info[3] = buf[7];
- err = 0;
- end:
- kfree(buf);
- return err;
- }
- EXPORT_SYMBOL(avc_general_get_plug_info);
- static DEFINE_SPINLOCK(transactions_lock);
- static LIST_HEAD(transactions);
- enum fcp_state {
- STATE_PENDING,
- STATE_BUS_RESET,
- STATE_COMPLETE,
- STATE_DEFERRED,
- };
- struct fcp_transaction {
- struct list_head list;
- struct fw_unit *unit;
- void *response_buffer;
- unsigned int response_size;
- unsigned int response_match_bytes;
- enum fcp_state state;
- wait_queue_head_t wait;
- bool deferrable;
- };
- int fcp_avc_transaction(struct fw_unit *unit,
- const void *command, unsigned int command_size,
- void *response, unsigned int response_size,
- unsigned int response_match_bytes)
- {
- struct fcp_transaction t;
- int tcode, ret, tries = 0;
- t.unit = unit;
- t.response_buffer = response;
- t.response_size = response_size;
- t.response_match_bytes = response_match_bytes;
- t.state = STATE_PENDING;
- init_waitqueue_head(&t.wait);
- if (*(const u8 *)command == 0x00 || *(const u8 *)command == 0x03)
- t.deferrable = true;
- spin_lock_irq(&transactions_lock);
- list_add_tail(&t.list, &transactions);
- spin_unlock_irq(&transactions_lock);
- for (;;) {
- tcode = command_size == 4 ? TCODE_WRITE_QUADLET_REQUEST
- : TCODE_WRITE_BLOCK_REQUEST;
- ret = snd_fw_transaction(t.unit, tcode,
- CSR_REGISTER_BASE + CSR_FCP_COMMAND,
- (void *)command, command_size, 0);
- if (ret < 0)
- break;
- deferred:
- wait_event_timeout(t.wait, t.state != STATE_PENDING,
- msecs_to_jiffies(FCP_TIMEOUT_MS));
- if (t.state == STATE_DEFERRED) {
-
- t.state = STATE_PENDING;
- goto deferred;
- } else if (t.state == STATE_COMPLETE) {
- ret = t.response_size;
- break;
- } else if (t.state == STATE_BUS_RESET) {
- msleep(ERROR_DELAY_MS);
- } else if (++tries >= ERROR_RETRIES) {
- dev_err(&t.unit->device, "FCP command timed out\n");
- ret = -EIO;
- break;
- }
- }
- spin_lock_irq(&transactions_lock);
- list_del(&t.list);
- spin_unlock_irq(&transactions_lock);
- return ret;
- }
- EXPORT_SYMBOL(fcp_avc_transaction);
- void fcp_bus_reset(struct fw_unit *unit)
- {
- struct fcp_transaction *t;
- spin_lock_irq(&transactions_lock);
- list_for_each_entry(t, &transactions, list) {
- if (t->unit == unit &&
- (t->state == STATE_PENDING ||
- t->state == STATE_DEFERRED)) {
- t->state = STATE_BUS_RESET;
- wake_up(&t->wait);
- }
- }
- spin_unlock_irq(&transactions_lock);
- }
- EXPORT_SYMBOL(fcp_bus_reset);
- static bool is_matching_response(struct fcp_transaction *transaction,
- const void *response, size_t length)
- {
- const u8 *p1, *p2;
- unsigned int mask, i;
- p1 = response;
- p2 = transaction->response_buffer;
- mask = transaction->response_match_bytes;
- for (i = 0; ; ++i) {
- if ((mask & 1) && p1[i] != p2[i])
- return false;
- mask >>= 1;
- if (!mask)
- return true;
- if (--length == 0)
- return false;
- }
- }
- static void fcp_response(struct fw_card *card, struct fw_request *request,
- int tcode, int destination, int source,
- int generation, unsigned long long offset,
- void *data, size_t length, void *callback_data)
- {
- struct fcp_transaction *t;
- unsigned long flags;
- if (length < 1 || (*(const u8 *)data & 0xf0) != CTS_AVC)
- return;
- spin_lock_irqsave(&transactions_lock, flags);
- list_for_each_entry(t, &transactions, list) {
- struct fw_device *device = fw_parent_device(t->unit);
- if (device->card != card ||
- device->generation != generation)
- continue;
- smp_rmb();
- if (device->node_id != source)
- continue;
- if (t->state == STATE_PENDING &&
- is_matching_response(t, data, length)) {
- if (t->deferrable && *(const u8 *)data == 0x0f) {
- t->state = STATE_DEFERRED;
- } else {
- t->state = STATE_COMPLETE;
- t->response_size = min_t(unsigned int, length,
- t->response_size);
- memcpy(t->response_buffer, data,
- t->response_size);
- }
- wake_up(&t->wait);
- }
- }
- spin_unlock_irqrestore(&transactions_lock, flags);
- }
- static struct fw_address_handler response_register_handler = {
- .length = 0x200,
- .address_callback = fcp_response,
- };
- static int __init fcp_module_init(void)
- {
- static const struct fw_address_region response_register_region = {
- .start = CSR_REGISTER_BASE + CSR_FCP_RESPONSE,
- .end = CSR_REGISTER_BASE + CSR_FCP_END,
- };
- fw_core_add_address_handler(&response_register_handler,
- &response_register_region);
- return 0;
- }
- static void __exit fcp_module_exit(void)
- {
- WARN_ON(!list_empty(&transactions));
- fw_core_remove_address_handler(&response_register_handler);
- }
- module_init(fcp_module_init);
- module_exit(fcp_module_exit);
|