|
@@ -9,11 +9,18 @@
|
|
|
#include <linux/kernel.h>
|
|
|
#include <linux/list.h>
|
|
|
#include <linux/mm.h>
|
|
|
+#include <linux/mod_devicetable.h>
|
|
|
+#include <linux/module.h>
|
|
|
+#include <linux/mutex.h>
|
|
|
#include <linux/slab.h>
|
|
|
#include <linux/spinlock.h>
|
|
|
+#include <linux/string.h>
|
|
|
#include <linux/types.h>
|
|
|
+#include <linux/wait.h>
|
|
|
+#include <linux/workqueue.h>
|
|
|
|
|
|
#include <asm/page.h>
|
|
|
+#include <asm/system.h>
|
|
|
|
|
|
#include <dvb_demux.h>
|
|
|
|
|
@@ -41,17 +48,17 @@ static int node_req(struct firedtv *fdtv, u64 addr, void *data, size_t len,
|
|
|
return rcode != RCODE_COMPLETE ? -EIO : 0;
|
|
|
}
|
|
|
|
|
|
-static int node_lock(struct firedtv *fdtv, u64 addr, void *data)
|
|
|
+int fdtv_lock(struct firedtv *fdtv, u64 addr, void *data)
|
|
|
{
|
|
|
return node_req(fdtv, addr, data, 8, TCODE_LOCK_COMPARE_SWAP);
|
|
|
}
|
|
|
|
|
|
-static int node_read(struct firedtv *fdtv, u64 addr, void *data)
|
|
|
+int fdtv_read(struct firedtv *fdtv, u64 addr, void *data)
|
|
|
{
|
|
|
return node_req(fdtv, addr, data, 4, TCODE_READ_QUADLET_REQUEST);
|
|
|
}
|
|
|
|
|
|
-static int node_write(struct firedtv *fdtv, u64 addr, void *data, size_t len)
|
|
|
+int fdtv_write(struct firedtv *fdtv, u64 addr, void *data, size_t len)
|
|
|
{
|
|
|
return node_req(fdtv, addr, data, len, TCODE_WRITE_BLOCK_REQUEST);
|
|
|
}
|
|
@@ -67,7 +74,7 @@ static int node_write(struct firedtv *fdtv, u64 addr, void *data, size_t len)
|
|
|
#define N_PAGES DIV_ROUND_UP(N_PACKETS, PACKETS_PER_PAGE)
|
|
|
#define IRQ_INTERVAL 16
|
|
|
|
|
|
-struct firedtv_receive_context {
|
|
|
+struct fdtv_ir_context {
|
|
|
struct fw_iso_context *context;
|
|
|
struct fw_iso_buffer buffer;
|
|
|
int interrupt_packet;
|
|
@@ -75,7 +82,7 @@ struct firedtv_receive_context {
|
|
|
char *pages[N_PAGES];
|
|
|
};
|
|
|
|
|
|
-static int queue_iso(struct firedtv_receive_context *ctx, int index)
|
|
|
+static int queue_iso(struct fdtv_ir_context *ctx, int index)
|
|
|
{
|
|
|
struct fw_iso_packet p;
|
|
|
|
|
@@ -92,7 +99,7 @@ static void handle_iso(struct fw_iso_context *context, u32 cycle,
|
|
|
size_t header_length, void *header, void *data)
|
|
|
{
|
|
|
struct firedtv *fdtv = data;
|
|
|
- struct firedtv_receive_context *ctx = fdtv->backend_data;
|
|
|
+ struct fdtv_ir_context *ctx = fdtv->ir_context;
|
|
|
__be32 *h, *h_end;
|
|
|
int length, err, i = ctx->current_packet;
|
|
|
char *p, *p_end;
|
|
@@ -121,9 +128,9 @@ static void handle_iso(struct fw_iso_context *context, u32 cycle,
|
|
|
ctx->current_packet = i;
|
|
|
}
|
|
|
|
|
|
-static int start_iso(struct firedtv *fdtv)
|
|
|
+int fdtv_start_iso(struct firedtv *fdtv)
|
|
|
{
|
|
|
- struct firedtv_receive_context *ctx;
|
|
|
+ struct fdtv_ir_context *ctx;
|
|
|
struct fw_device *device = device_of(fdtv);
|
|
|
int i, err;
|
|
|
|
|
@@ -161,7 +168,7 @@ static int start_iso(struct firedtv *fdtv)
|
|
|
if (err)
|
|
|
goto fail;
|
|
|
|
|
|
- fdtv->backend_data = ctx;
|
|
|
+ fdtv->ir_context = ctx;
|
|
|
|
|
|
return 0;
|
|
|
fail:
|
|
@@ -174,9 +181,9 @@ fail_free:
|
|
|
return err;
|
|
|
}
|
|
|
|
|
|
-static void stop_iso(struct firedtv *fdtv)
|
|
|
+void fdtv_stop_iso(struct firedtv *fdtv)
|
|
|
{
|
|
|
- struct firedtv_receive_context *ctx = fdtv->backend_data;
|
|
|
+ struct fdtv_ir_context *ctx = fdtv->ir_context;
|
|
|
|
|
|
fw_iso_context_stop(ctx->context);
|
|
|
fw_iso_buffer_destroy(&ctx->buffer, device_of(fdtv)->card);
|
|
@@ -184,14 +191,6 @@ static void stop_iso(struct firedtv *fdtv)
|
|
|
kfree(ctx);
|
|
|
}
|
|
|
|
|
|
-static const struct firedtv_backend backend = {
|
|
|
- .lock = node_lock,
|
|
|
- .read = node_read,
|
|
|
- .write = node_write,
|
|
|
- .start_iso = start_iso,
|
|
|
- .stop_iso = stop_iso,
|
|
|
-};
|
|
|
-
|
|
|
static void handle_fcp(struct fw_card *card, struct fw_request *request,
|
|
|
int tcode, int destination, int source, int generation,
|
|
|
unsigned long long offset, void *payload, size_t length,
|
|
@@ -238,6 +237,14 @@ static const struct fw_address_region fcp_region = {
|
|
|
.end = CSR_REGISTER_BASE + CSR_FCP_END,
|
|
|
};
|
|
|
|
|
|
+static const char * const model_names[] = {
|
|
|
+ [FIREDTV_UNKNOWN] = "unknown type",
|
|
|
+ [FIREDTV_DVB_S] = "FireDTV S/CI",
|
|
|
+ [FIREDTV_DVB_C] = "FireDTV C/CI",
|
|
|
+ [FIREDTV_DVB_T] = "FireDTV T/CI",
|
|
|
+ [FIREDTV_DVB_S2] = "FireDTV S2 ",
|
|
|
+};
|
|
|
+
|
|
|
/* Adjust the template string if models with longer names appear. */
|
|
|
#define MAX_MODEL_NAME_LEN sizeof("FireDTV ????")
|
|
|
|
|
@@ -245,15 +252,31 @@ static int node_probe(struct device *dev)
|
|
|
{
|
|
|
struct firedtv *fdtv;
|
|
|
char name[MAX_MODEL_NAME_LEN];
|
|
|
- int name_len, err;
|
|
|
-
|
|
|
- name_len = fw_csr_string(fw_unit(dev)->directory, CSR_MODEL,
|
|
|
- name, sizeof(name));
|
|
|
+ int name_len, i, err;
|
|
|
|
|
|
- fdtv = fdtv_alloc(dev, &backend, name, name_len >= 0 ? name_len : 0);
|
|
|
+ fdtv = kzalloc(sizeof(*fdtv), GFP_KERNEL);
|
|
|
if (!fdtv)
|
|
|
return -ENOMEM;
|
|
|
|
|
|
+ dev_set_drvdata(dev, fdtv);
|
|
|
+ fdtv->device = dev;
|
|
|
+ fdtv->isochannel = -1;
|
|
|
+ fdtv->voltage = 0xff;
|
|
|
+ fdtv->tone = 0xff;
|
|
|
+
|
|
|
+ mutex_init(&fdtv->avc_mutex);
|
|
|
+ init_waitqueue_head(&fdtv->avc_wait);
|
|
|
+ mutex_init(&fdtv->demux_mutex);
|
|
|
+ INIT_WORK(&fdtv->remote_ctrl_work, avc_remote_ctrl_work);
|
|
|
+
|
|
|
+ name_len = fw_csr_string(fw_unit(dev)->directory, CSR_MODEL,
|
|
|
+ name, sizeof(name));
|
|
|
+ for (i = ARRAY_SIZE(model_names); --i; )
|
|
|
+ if (strlen(model_names[i]) <= name_len &&
|
|
|
+ strncmp(name, model_names[i], name_len) == 0)
|
|
|
+ break;
|
|
|
+ fdtv->type = i;
|
|
|
+
|
|
|
err = fdtv_register_rc(fdtv, dev);
|
|
|
if (err)
|
|
|
goto fail_free;
|
|
@@ -266,7 +289,7 @@ static int node_probe(struct device *dev)
|
|
|
if (err)
|
|
|
goto fail;
|
|
|
|
|
|
- err = fdtv_dvb_register(fdtv);
|
|
|
+ err = fdtv_dvb_register(fdtv, model_names[fdtv->type]);
|
|
|
if (err)
|
|
|
goto fail;
|
|
|
|
|
@@ -309,6 +332,60 @@ static void node_update(struct fw_unit *unit)
|
|
|
fdtv->isochannel);
|
|
|
}
|
|
|
|
|
|
+#define MATCH_FLAGS (IEEE1394_MATCH_VENDOR_ID | IEEE1394_MATCH_MODEL_ID | \
|
|
|
+ IEEE1394_MATCH_SPECIFIER_ID | IEEE1394_MATCH_VERSION)
|
|
|
+
|
|
|
+#define DIGITAL_EVERYWHERE_OUI 0x001287
|
|
|
+#define AVC_UNIT_SPEC_ID_ENTRY 0x00a02d
|
|
|
+#define AVC_SW_VERSION_ENTRY 0x010001
|
|
|
+
|
|
|
+static const struct ieee1394_device_id fdtv_id_table[] = {
|
|
|
+ {
|
|
|
+ /* FloppyDTV S/CI and FloppyDTV S2 */
|
|
|
+ .match_flags = MATCH_FLAGS,
|
|
|
+ .vendor_id = DIGITAL_EVERYWHERE_OUI,
|
|
|
+ .model_id = 0x000024,
|
|
|
+ .specifier_id = AVC_UNIT_SPEC_ID_ENTRY,
|
|
|
+ .version = AVC_SW_VERSION_ENTRY,
|
|
|
+ }, {
|
|
|
+ /* FloppyDTV T/CI */
|
|
|
+ .match_flags = MATCH_FLAGS,
|
|
|
+ .vendor_id = DIGITAL_EVERYWHERE_OUI,
|
|
|
+ .model_id = 0x000025,
|
|
|
+ .specifier_id = AVC_UNIT_SPEC_ID_ENTRY,
|
|
|
+ .version = AVC_SW_VERSION_ENTRY,
|
|
|
+ }, {
|
|
|
+ /* FloppyDTV C/CI */
|
|
|
+ .match_flags = MATCH_FLAGS,
|
|
|
+ .vendor_id = DIGITAL_EVERYWHERE_OUI,
|
|
|
+ .model_id = 0x000026,
|
|
|
+ .specifier_id = AVC_UNIT_SPEC_ID_ENTRY,
|
|
|
+ .version = AVC_SW_VERSION_ENTRY,
|
|
|
+ }, {
|
|
|
+ /* FireDTV S/CI and FloppyDTV S2 */
|
|
|
+ .match_flags = MATCH_FLAGS,
|
|
|
+ .vendor_id = DIGITAL_EVERYWHERE_OUI,
|
|
|
+ .model_id = 0x000034,
|
|
|
+ .specifier_id = AVC_UNIT_SPEC_ID_ENTRY,
|
|
|
+ .version = AVC_SW_VERSION_ENTRY,
|
|
|
+ }, {
|
|
|
+ /* FireDTV T/CI */
|
|
|
+ .match_flags = MATCH_FLAGS,
|
|
|
+ .vendor_id = DIGITAL_EVERYWHERE_OUI,
|
|
|
+ .model_id = 0x000035,
|
|
|
+ .specifier_id = AVC_UNIT_SPEC_ID_ENTRY,
|
|
|
+ .version = AVC_SW_VERSION_ENTRY,
|
|
|
+ }, {
|
|
|
+ /* FireDTV C/CI */
|
|
|
+ .match_flags = MATCH_FLAGS,
|
|
|
+ .vendor_id = DIGITAL_EVERYWHERE_OUI,
|
|
|
+ .model_id = 0x000036,
|
|
|
+ .specifier_id = AVC_UNIT_SPEC_ID_ENTRY,
|
|
|
+ .version = AVC_SW_VERSION_ENTRY,
|
|
|
+ }, {}
|
|
|
+};
|
|
|
+MODULE_DEVICE_TABLE(ieee1394, fdtv_id_table);
|
|
|
+
|
|
|
static struct fw_driver fdtv_driver = {
|
|
|
.driver = {
|
|
|
.owner = THIS_MODULE,
|
|
@@ -321,7 +398,7 @@ static struct fw_driver fdtv_driver = {
|
|
|
.id_table = fdtv_id_table,
|
|
|
};
|
|
|
|
|
|
-int __init fdtv_fw_init(void)
|
|
|
+static int __init fdtv_init(void)
|
|
|
{
|
|
|
int ret;
|
|
|
|
|
@@ -329,11 +406,24 @@ int __init fdtv_fw_init(void)
|
|
|
if (ret < 0)
|
|
|
return ret;
|
|
|
|
|
|
- return driver_register(&fdtv_driver.driver);
|
|
|
+ ret = driver_register(&fdtv_driver.driver);
|
|
|
+ if (ret < 0)
|
|
|
+ fw_core_remove_address_handler(&fcp_handler);
|
|
|
+
|
|
|
+ return ret;
|
|
|
}
|
|
|
|
|
|
-void fdtv_fw_exit(void)
|
|
|
+static void __exit fdtv_exit(void)
|
|
|
{
|
|
|
driver_unregister(&fdtv_driver.driver);
|
|
|
fw_core_remove_address_handler(&fcp_handler);
|
|
|
}
|
|
|
+
|
|
|
+module_init(fdtv_init);
|
|
|
+module_exit(fdtv_exit);
|
|
|
+
|
|
|
+MODULE_AUTHOR("Andreas Monitzer <andy@monitzer.com>");
|
|
|
+MODULE_AUTHOR("Ben Backx <ben@bbackx.com>");
|
|
|
+MODULE_DESCRIPTION("FireDTV DVB Driver");
|
|
|
+MODULE_LICENSE("GPL");
|
|
|
+MODULE_SUPPORTED_DEVICE("FireDTV DVB");
|