drivers/media/dvb/firewire/firedtv-1394.c

   1 /*
   2  * FireDTV driver (formerly known as FireSAT)
   3  *
   4  * Copyright (C) 2004 Andreas Monitzer <andy@monitzer.com>
   5  * Copyright (C) 2007-2008 Ben Backx <ben@bbackx.com>
   6  * Copyright (C) 2008 Henrik Kurelid <henrik@kurelid.se>
   7  *
   8  *      This program is free software; you can redistribute it and/or
   9  *      modify it under the terms of the GNU General Public License as
  10  *      published by the Free Software Foundation; either version 2 of
  11  *      the License, or (at your option) any later version.
  12  */
  13
  14 #include <linux/device.h>
  15 #include <linux/errno.h>
  16 #include <linux/kernel.h>
  17 #include <linux/list.h>
  18 #include <linux/spinlock.h>
  19 #include <linux/types.h>
  20
  21 #include <dma.h>
  22 #include <csr1212.h>
  23 #include <highlevel.h>
  24 #include <hosts.h>
  25 #include <ieee1394.h>
  26 #include <iso.h>
  27 #include <nodemgr.h>
  28
  29 #include "firedtv.h"
  30
  31 static LIST_HEAD(node_list);
  32 static DEFINE_SPINLOCK(node_list_lock);
  33
  34 #define FIREWIRE_HEADER_SIZE    4
  35 #define CIP_HEADER_SIZE         8
  36
  37 static void rawiso_activity_cb(struct hpsb_iso *iso)
  38 {
  39         struct firedtv *f, *fdtv = NULL;
  40         unsigned int i, num, packet;
  41         unsigned char *buf;
  42         unsigned long flags;
  43         int count;
  44
  45         spin_lock_irqsave(&node_list_lock, flags);
  46         list_for_each_entry(f, &node_list, list)
  47                 if (f->backend_data == iso) {
  48                         fdtv = f;
  49                         break;
  50                 }
  51         spin_unlock_irqrestore(&node_list_lock, flags);
  52
  53         packet = iso->first_packet;
  54         num = hpsb_iso_n_ready(iso);
  55
  56         if (!fdtv) {
  57                 dev_err(fdtv->device, "received at unknown iso channel\n");
  58                 goto out;
  59         }
  60
  61         for (i = 0; i < num; i++, packet = (packet + 1) % iso->buf_packets) {
  62                 buf = dma_region_i(&iso->data_buf, unsigned char,
  63                         iso->infos[packet].offset + CIP_HEADER_SIZE);
  64                 count = (iso->infos[packet].len - CIP_HEADER_SIZE) /
  65                         (188 + FIREWIRE_HEADER_SIZE);
  66
  67                 /* ignore empty packet */
  68                 if (iso->infos[packet].len <= CIP_HEADER_SIZE)
  69                         continue;
  70
  71                 while (count--) {
  72                         if (buf[FIREWIRE_HEADER_SIZE] == 0x47)
  73                                 dvb_dmx_swfilter_packets(&fdtv->demux,
  74                                                 &buf[FIREWIRE_HEADER_SIZE], 1);
  75                         else
  76                                 dev_err(fdtv->device,
  77                                         "skipping invalid packet\n");
  78                         buf += 188 + FIREWIRE_HEADER_SIZE;
  79                 }
  80         }
  81 out:
  82         hpsb_iso_recv_release_packets(iso, num);
  83 }
  84
  85 static inline struct node_entry *node_of(struct firedtv *fdtv)
  86 {
  87         return container_of(fdtv->device, struct unit_directory, device)->ne;
  88 }
  89
  90 static int node_lock(struct firedtv *fdtv, u64 addr, __be32 data[])
  91 {
  92         int ret;
  93
  94         ret = hpsb_node_lock(node_of(fdtv), addr, EXTCODE_COMPARE_SWAP,
  95                 (__force quadlet_t *)&data[1], (__force quadlet_t)data[0]);
  96         data[0] = data[1];
  97
  98         return ret;
  99 }
 100
 101 static int node_read(struct firedtv *fdtv, u64 addr, void *data, size_t len)
 102 {
 103         return hpsb_node_read(node_of(fdtv), addr, data, len);
 104 }
 105
 106 static int node_write(struct firedtv *fdtv, u64 addr, void *data, size_t len)
 107 {
 108         return hpsb_node_write(node_of(fdtv), addr, data, len);
 109 }
 110
 111 #define FDTV_ISO_BUFFER_PACKETS 256
 112 #define FDTV_ISO_BUFFER_SIZE (FDTV_ISO_BUFFER_PACKETS * 200)
 113
 114 static int start_iso(struct firedtv *fdtv)
 115 {
 116         struct hpsb_iso *iso_handle;
 117         int ret;
 118
 119         iso_handle = hpsb_iso_recv_init(node_of(fdtv)->host,
 120                                 FDTV_ISO_BUFFER_SIZE, FDTV_ISO_BUFFER_PACKETS,
 121                                 fdtv->isochannel, HPSB_ISO_DMA_DEFAULT,
 122                                 -1, /* stat.config.irq_interval */
 123                                 rawiso_activity_cb);
 124         if (iso_handle == NULL) {
 125                 dev_err(fdtv->device, "cannot initialize iso receive\n");
 126                 return -ENOMEM;
 127         }
 128         fdtv->backend_data = iso_handle;
 129
 130         ret = hpsb_iso_recv_start(iso_handle, -1, -1, 0);
 131         if (ret != 0) {
 132                 dev_err(fdtv->device, "cannot start iso receive\n");
 133                 hpsb_iso_shutdown(iso_handle);
 134                 fdtv->backend_data = NULL;
 135         }
 136         return ret;
 137 }
 138
 139 static void stop_iso(struct firedtv *fdtv)
 140 {
 141         struct hpsb_iso *iso_handle = fdtv->backend_data;
 142
 143         if (iso_handle != NULL) {
 144                 hpsb_iso_stop(iso_handle);
 145                 hpsb_iso_shutdown(iso_handle);
 146         }
 147         fdtv->backend_data = NULL;
 148 }
 149
 150 static const struct firedtv_backend fdtv_1394_backend = {
 151         .lock           = node_lock,
 152         .read           = node_read,
 153         .write          = node_write,
 154         .start_iso      = start_iso,
 155         .stop_iso       = stop_iso,
 156 };
 157
 158 static void fcp_request(struct hpsb_host *host, int nodeid, int direction,
 159                         int cts, u8 *data, size_t length)
 160 {
 161         struct firedtv *f, *fdtv = NULL;
 162         unsigned long flags;
 163         int su;
 164
 165         if (length == 0 || (data[0] & 0xf0) != 0)
 166                 return;
 167
 168         su = data[1] & 0x7;
 169
 170         spin_lock_irqsave(&node_list_lock, flags);
 171         list_for_each_entry(f, &node_list, list)
 172                 if (node_of(f)->host == host &&
 173                     node_of(f)->nodeid == nodeid &&
 174                     (f->subunit == su || (f->subunit == 0 && su == 0x7))) {
 175                         fdtv = f;
 176                         break;
 177                 }
 178         spin_unlock_irqrestore(&node_list_lock, flags);
 179
 180         if (fdtv)
 181                 avc_recv(fdtv, data, length);
 182 }
 183
 184 static int node_probe(struct device *dev)
 185 {
 186         struct unit_directory *ud =
 187                         container_of(dev, struct unit_directory, device);
 188         struct firedtv *fdtv;
 189         int kv_len, err;
 190         void *kv_str;
 191
 192         kv_len = (ud->model_name_kv->value.leaf.len - 2) * sizeof(quadlet_t);
 193         kv_str = CSR1212_TEXTUAL_DESCRIPTOR_LEAF_DATA(ud->model_name_kv);
 194
 195         fdtv = fdtv_alloc(dev, &fdtv_1394_backend, kv_str, kv_len);
 196         if (!fdtv)
 197                 return -ENOMEM;
 198
 199         /*
 200          * Work around a bug in udev's path_id script:  Use the fw-host's dev
 201          * instead of the unit directory's dev as parent of the input device.
 202          */
 203         err = fdtv_register_rc(fdtv, dev->parent->parent);
 204         if (err)
 205                 goto fail_free;
 206
 207         spin_lock_irq(&node_list_lock);
 208         list_add_tail(&fdtv->list, &node_list);
 209         spin_unlock_irq(&node_list_lock);
 210
 211         err = avc_identify_subunit(fdtv);
 212         if (err)
 213                 goto fail;
 214
 215         err = fdtv_dvb_register(fdtv);
 216         if (err)
 217                 goto fail;
 218
 219         avc_register_remote_control(fdtv);
 220
 221         return 0;
 222 fail:
 223         spin_lock_irq(&node_list_lock);
 224         list_del(&fdtv->list);
 225         spin_unlock_irq(&node_list_lock);
 226         fdtv_unregister_rc(fdtv);
 227 fail_free:
 228         kfree(fdtv);
 229
 230         return err;
 231 }
 232
 233 static int node_remove(struct device *dev)
 234 {
 235         struct firedtv *fdtv = dev_get_drvdata(dev);
 236
 237         fdtv_dvb_unregister(fdtv);
 238
 239         spin_lock_irq(&node_list_lock);
 240         list_del(&fdtv->list);
 241         spin_unlock_irq(&node_list_lock);
 242
 243         fdtv_unregister_rc(fdtv);
 244         kfree(fdtv);
 245
 246         return 0;
 247 }
 248
 249 static int node_update(struct unit_directory *ud)
 250 {
 251         struct firedtv *fdtv = dev_get_drvdata(&ud->device);
 252
 253         if (fdtv->isochannel >= 0)
 254                 cmp_establish_pp_connection(fdtv, fdtv->subunit,
 255                                             fdtv->isochannel);
 256         return 0;
 257 }
 258
 259 static struct hpsb_protocol_driver fdtv_driver = {
 260         .name           = "firedtv",
 261         .update         = node_update,
 262         .driver         = {
 263                 .probe  = node_probe,
 264                 .remove = node_remove,
 265         },
 266 };
 267
 268 static struct hpsb_highlevel fdtv_highlevel = {
 269         .name           = "firedtv",
 270         .fcp_request    = fcp_request,
 271 };
 272
 273 int __init fdtv_1394_init(struct ieee1394_device_id id_table[])
 274 {
 275         int ret;
 276
 277         hpsb_register_highlevel(&fdtv_highlevel);
 278         fdtv_driver.id_table = id_table;
 279         ret = hpsb_register_protocol(&fdtv_driver);
 280         if (ret) {
 281                 printk(KERN_ERR "firedtv: failed to register protocol\n");
 282                 hpsb_unregister_highlevel(&fdtv_highlevel);
 283         }
 284         return ret;
 285 }
 286
 287 void __exit fdtv_1394_exit(void)
 288 {
 289         hpsb_unregister_protocol(&fdtv_driver);
 290         hpsb_unregister_highlevel(&fdtv_highlevel);
 291 }