1616300bdSMauro Carvalho Chehab /* 2616300bdSMauro Carvalho Chehab * FireDTV driver (formerly known as FireSAT) 3616300bdSMauro Carvalho Chehab * 4616300bdSMauro Carvalho Chehab * Copyright (C) 2004 Andreas Monitzer <andy@monitzer.com> 5616300bdSMauro Carvalho Chehab * Copyright (C) 2008 Ben Backx <ben@bbackx.com> 6616300bdSMauro Carvalho Chehab * Copyright (C) 2008 Henrik Kurelid <henrik@kurelid.se> 7616300bdSMauro Carvalho Chehab * 8616300bdSMauro Carvalho Chehab * This program is free software; you can redistribute it and/or 9616300bdSMauro Carvalho Chehab * modify it under the terms of the GNU General Public License as 10616300bdSMauro Carvalho Chehab * published by the Free Software Foundation; either version 2 of 11616300bdSMauro Carvalho Chehab * the License, or (at your option) any later version. 12616300bdSMauro Carvalho Chehab */ 13616300bdSMauro Carvalho Chehab 14616300bdSMauro Carvalho Chehab #include <linux/bug.h> 15616300bdSMauro Carvalho Chehab #include <linux/crc32.h> 16616300bdSMauro Carvalho Chehab #include <linux/delay.h> 17616300bdSMauro Carvalho Chehab #include <linux/device.h> 18616300bdSMauro Carvalho Chehab #include <linux/jiffies.h> 19616300bdSMauro Carvalho Chehab #include <linux/kernel.h> 20616300bdSMauro Carvalho Chehab #include <linux/moduleparam.h> 21616300bdSMauro Carvalho Chehab #include <linux/mutex.h> 22616300bdSMauro Carvalho Chehab #include <linux/string.h> 23616300bdSMauro Carvalho Chehab #include <linux/stringify.h> 24616300bdSMauro Carvalho Chehab #include <linux/wait.h> 25616300bdSMauro Carvalho Chehab #include <linux/workqueue.h> 26616300bdSMauro Carvalho Chehab 27616300bdSMauro Carvalho Chehab #include <dvb_frontend.h> 28616300bdSMauro Carvalho Chehab 29616300bdSMauro Carvalho Chehab #include "firedtv.h" 30616300bdSMauro Carvalho Chehab 31616300bdSMauro Carvalho Chehab #define FCP_COMMAND_REGISTER 0xfffff0000b00ULL 32616300bdSMauro Carvalho Chehab 33616300bdSMauro Carvalho Chehab #define AVC_CTYPE_CONTROL 0x0 34616300bdSMauro Carvalho Chehab #define AVC_CTYPE_STATUS 0x1 35616300bdSMauro Carvalho Chehab #define AVC_CTYPE_NOTIFY 0x3 36616300bdSMauro Carvalho Chehab 37616300bdSMauro Carvalho Chehab #define AVC_RESPONSE_ACCEPTED 0x9 38616300bdSMauro Carvalho Chehab #define AVC_RESPONSE_STABLE 0xc 39616300bdSMauro Carvalho Chehab #define AVC_RESPONSE_CHANGED 0xd 40616300bdSMauro Carvalho Chehab #define AVC_RESPONSE_INTERIM 0xf 41616300bdSMauro Carvalho Chehab 42616300bdSMauro Carvalho Chehab #define AVC_SUBUNIT_TYPE_TUNER (0x05 << 3) 43616300bdSMauro Carvalho Chehab #define AVC_SUBUNIT_TYPE_UNIT (0x1f << 3) 44616300bdSMauro Carvalho Chehab 45616300bdSMauro Carvalho Chehab #define AVC_OPCODE_VENDOR 0x00 46616300bdSMauro Carvalho Chehab #define AVC_OPCODE_READ_DESCRIPTOR 0x09 47616300bdSMauro Carvalho Chehab #define AVC_OPCODE_DSIT 0xc8 48616300bdSMauro Carvalho Chehab #define AVC_OPCODE_DSD 0xcb 49616300bdSMauro Carvalho Chehab 50616300bdSMauro Carvalho Chehab #define DESCRIPTOR_TUNER_STATUS 0x80 51616300bdSMauro Carvalho Chehab #define DESCRIPTOR_SUBUNIT_IDENTIFIER 0x00 52616300bdSMauro Carvalho Chehab 53616300bdSMauro Carvalho Chehab #define SFE_VENDOR_DE_COMPANYID_0 0x00 /* OUI of Digital Everywhere */ 54616300bdSMauro Carvalho Chehab #define SFE_VENDOR_DE_COMPANYID_1 0x12 55616300bdSMauro Carvalho Chehab #define SFE_VENDOR_DE_COMPANYID_2 0x87 56616300bdSMauro Carvalho Chehab 57616300bdSMauro Carvalho Chehab #define SFE_VENDOR_OPCODE_REGISTER_REMOTE_CONTROL 0x0a 58616300bdSMauro Carvalho Chehab #define SFE_VENDOR_OPCODE_LNB_CONTROL 0x52 59616300bdSMauro Carvalho Chehab #define SFE_VENDOR_OPCODE_TUNE_QPSK 0x58 /* for DVB-S */ 60616300bdSMauro Carvalho Chehab 61616300bdSMauro Carvalho Chehab #define SFE_VENDOR_OPCODE_GET_FIRMWARE_VERSION 0x00 62616300bdSMauro Carvalho Chehab #define SFE_VENDOR_OPCODE_HOST2CA 0x56 63616300bdSMauro Carvalho Chehab #define SFE_VENDOR_OPCODE_CA2HOST 0x57 64616300bdSMauro Carvalho Chehab #define SFE_VENDOR_OPCODE_CISTATUS 0x59 65616300bdSMauro Carvalho Chehab #define SFE_VENDOR_OPCODE_TUNE_QPSK2 0x60 /* for DVB-S2 */ 66616300bdSMauro Carvalho Chehab 67616300bdSMauro Carvalho Chehab #define SFE_VENDOR_TAG_CA_RESET 0x00 68616300bdSMauro Carvalho Chehab #define SFE_VENDOR_TAG_CA_APPLICATION_INFO 0x01 69616300bdSMauro Carvalho Chehab #define SFE_VENDOR_TAG_CA_PMT 0x02 70616300bdSMauro Carvalho Chehab #define SFE_VENDOR_TAG_CA_DATE_TIME 0x04 71616300bdSMauro Carvalho Chehab #define SFE_VENDOR_TAG_CA_MMI 0x05 72616300bdSMauro Carvalho Chehab #define SFE_VENDOR_TAG_CA_ENTER_MENU 0x07 73616300bdSMauro Carvalho Chehab 74616300bdSMauro Carvalho Chehab #define EN50221_LIST_MANAGEMENT_ONLY 0x03 75616300bdSMauro Carvalho Chehab #define EN50221_TAG_APP_INFO 0x9f8021 76616300bdSMauro Carvalho Chehab #define EN50221_TAG_CA_INFO 0x9f8031 77616300bdSMauro Carvalho Chehab 78616300bdSMauro Carvalho Chehab struct avc_command_frame { 79616300bdSMauro Carvalho Chehab u8 ctype; 80616300bdSMauro Carvalho Chehab u8 subunit; 81616300bdSMauro Carvalho Chehab u8 opcode; 82616300bdSMauro Carvalho Chehab u8 operand[509]; 83616300bdSMauro Carvalho Chehab }; 84616300bdSMauro Carvalho Chehab 85616300bdSMauro Carvalho Chehab struct avc_response_frame { 86616300bdSMauro Carvalho Chehab u8 response; 87616300bdSMauro Carvalho Chehab u8 subunit; 88616300bdSMauro Carvalho Chehab u8 opcode; 89616300bdSMauro Carvalho Chehab u8 operand[509]; 90616300bdSMauro Carvalho Chehab }; 91616300bdSMauro Carvalho Chehab 92616300bdSMauro Carvalho Chehab #define LAST_OPERAND (509 - 1) 93616300bdSMauro Carvalho Chehab 94616300bdSMauro Carvalho Chehab static inline void clear_operands(struct avc_command_frame *c, int from, int to) 95616300bdSMauro Carvalho Chehab { 96616300bdSMauro Carvalho Chehab memset(&c->operand[from], 0, to - from + 1); 97616300bdSMauro Carvalho Chehab } 98616300bdSMauro Carvalho Chehab 99616300bdSMauro Carvalho Chehab static void pad_operands(struct avc_command_frame *c, int from) 100616300bdSMauro Carvalho Chehab { 101616300bdSMauro Carvalho Chehab int to = ALIGN(from, 4); 102616300bdSMauro Carvalho Chehab 103616300bdSMauro Carvalho Chehab if (from <= to && to <= LAST_OPERAND) 104616300bdSMauro Carvalho Chehab clear_operands(c, from, to); 105616300bdSMauro Carvalho Chehab } 106616300bdSMauro Carvalho Chehab 107616300bdSMauro Carvalho Chehab #define AVC_DEBUG_READ_DESCRIPTOR 0x0001 108616300bdSMauro Carvalho Chehab #define AVC_DEBUG_DSIT 0x0002 109616300bdSMauro Carvalho Chehab #define AVC_DEBUG_DSD 0x0004 110616300bdSMauro Carvalho Chehab #define AVC_DEBUG_REGISTER_REMOTE_CONTROL 0x0008 111616300bdSMauro Carvalho Chehab #define AVC_DEBUG_LNB_CONTROL 0x0010 112616300bdSMauro Carvalho Chehab #define AVC_DEBUG_TUNE_QPSK 0x0020 113616300bdSMauro Carvalho Chehab #define AVC_DEBUG_TUNE_QPSK2 0x0040 114616300bdSMauro Carvalho Chehab #define AVC_DEBUG_HOST2CA 0x0080 115616300bdSMauro Carvalho Chehab #define AVC_DEBUG_CA2HOST 0x0100 116616300bdSMauro Carvalho Chehab #define AVC_DEBUG_APPLICATION_PMT 0x4000 117616300bdSMauro Carvalho Chehab #define AVC_DEBUG_FCP_PAYLOADS 0x8000 118616300bdSMauro Carvalho Chehab 119616300bdSMauro Carvalho Chehab static int avc_debug; 120616300bdSMauro Carvalho Chehab module_param_named(debug, avc_debug, int, 0644); 121616300bdSMauro Carvalho Chehab MODULE_PARM_DESC(debug, "Verbose logging (none = 0" 122616300bdSMauro Carvalho Chehab ", FCP subactions" 123616300bdSMauro Carvalho Chehab ": READ DESCRIPTOR = " __stringify(AVC_DEBUG_READ_DESCRIPTOR) 124616300bdSMauro Carvalho Chehab ", DSIT = " __stringify(AVC_DEBUG_DSIT) 125616300bdSMauro Carvalho Chehab ", REGISTER_REMOTE_CONTROL = " __stringify(AVC_DEBUG_REGISTER_REMOTE_CONTROL) 126616300bdSMauro Carvalho Chehab ", LNB CONTROL = " __stringify(AVC_DEBUG_LNB_CONTROL) 127616300bdSMauro Carvalho Chehab ", TUNE QPSK = " __stringify(AVC_DEBUG_TUNE_QPSK) 128616300bdSMauro Carvalho Chehab ", TUNE QPSK2 = " __stringify(AVC_DEBUG_TUNE_QPSK2) 129616300bdSMauro Carvalho Chehab ", HOST2CA = " __stringify(AVC_DEBUG_HOST2CA) 130616300bdSMauro Carvalho Chehab ", CA2HOST = " __stringify(AVC_DEBUG_CA2HOST) 131616300bdSMauro Carvalho Chehab "; Application sent PMT = " __stringify(AVC_DEBUG_APPLICATION_PMT) 132616300bdSMauro Carvalho Chehab ", FCP payloads = " __stringify(AVC_DEBUG_FCP_PAYLOADS) 133616300bdSMauro Carvalho Chehab ", or a combination, or all = -1)"); 134616300bdSMauro Carvalho Chehab 135616300bdSMauro Carvalho Chehab /* 136616300bdSMauro Carvalho Chehab * This is a workaround since there is no vendor specific command to retrieve 137616300bdSMauro Carvalho Chehab * ca_info using AVC. If this parameter is not used, ca_system_id will be 138616300bdSMauro Carvalho Chehab * filled with application_manufacturer from ca_app_info. 139616300bdSMauro Carvalho Chehab * Digital Everywhere have said that adding ca_info is on their TODO list. 140616300bdSMauro Carvalho Chehab */ 141616300bdSMauro Carvalho Chehab static unsigned int num_fake_ca_system_ids; 142616300bdSMauro Carvalho Chehab static int fake_ca_system_ids[4] = { -1, -1, -1, -1 }; 143616300bdSMauro Carvalho Chehab module_param_array(fake_ca_system_ids, int, &num_fake_ca_system_ids, 0644); 144616300bdSMauro Carvalho Chehab MODULE_PARM_DESC(fake_ca_system_ids, "If your CAM application manufacturer " 145616300bdSMauro Carvalho Chehab "does not have the same ca_system_id as your CAS, you can " 146616300bdSMauro Carvalho Chehab "override what ca_system_ids are presented to the " 147616300bdSMauro Carvalho Chehab "application by setting this field to an array of ids."); 148616300bdSMauro Carvalho Chehab 149616300bdSMauro Carvalho Chehab static const char *debug_fcp_ctype(unsigned int ctype) 150616300bdSMauro Carvalho Chehab { 151616300bdSMauro Carvalho Chehab static const char *ctypes[] = { 152616300bdSMauro Carvalho Chehab [0x0] = "CONTROL", [0x1] = "STATUS", 153616300bdSMauro Carvalho Chehab [0x2] = "SPECIFIC INQUIRY", [0x3] = "NOTIFY", 154616300bdSMauro Carvalho Chehab [0x4] = "GENERAL INQUIRY", [0x8] = "NOT IMPLEMENTED", 155616300bdSMauro Carvalho Chehab [0x9] = "ACCEPTED", [0xa] = "REJECTED", 156616300bdSMauro Carvalho Chehab [0xb] = "IN TRANSITION", [0xc] = "IMPLEMENTED/STABLE", 157616300bdSMauro Carvalho Chehab [0xd] = "CHANGED", [0xf] = "INTERIM", 158616300bdSMauro Carvalho Chehab }; 159616300bdSMauro Carvalho Chehab const char *ret = ctype < ARRAY_SIZE(ctypes) ? ctypes[ctype] : NULL; 160616300bdSMauro Carvalho Chehab 161616300bdSMauro Carvalho Chehab return ret ? ret : "?"; 162616300bdSMauro Carvalho Chehab } 163616300bdSMauro Carvalho Chehab 164616300bdSMauro Carvalho Chehab static const char *debug_fcp_opcode(unsigned int opcode, 165616300bdSMauro Carvalho Chehab const u8 *data, int length) 166616300bdSMauro Carvalho Chehab { 167616300bdSMauro Carvalho Chehab switch (opcode) { 168616300bdSMauro Carvalho Chehab case AVC_OPCODE_VENDOR: 169616300bdSMauro Carvalho Chehab break; 170616300bdSMauro Carvalho Chehab case AVC_OPCODE_READ_DESCRIPTOR: 171616300bdSMauro Carvalho Chehab return avc_debug & AVC_DEBUG_READ_DESCRIPTOR ? 172616300bdSMauro Carvalho Chehab "ReadDescriptor" : NULL; 173616300bdSMauro Carvalho Chehab case AVC_OPCODE_DSIT: 174616300bdSMauro Carvalho Chehab return avc_debug & AVC_DEBUG_DSIT ? 175616300bdSMauro Carvalho Chehab "DirectSelectInfo.Type" : NULL; 176616300bdSMauro Carvalho Chehab case AVC_OPCODE_DSD: 177616300bdSMauro Carvalho Chehab return avc_debug & AVC_DEBUG_DSD ? "DirectSelectData" : NULL; 178616300bdSMauro Carvalho Chehab default: 179616300bdSMauro Carvalho Chehab return "Unknown"; 180616300bdSMauro Carvalho Chehab } 181616300bdSMauro Carvalho Chehab 182616300bdSMauro Carvalho Chehab if (length < 7 || 183616300bdSMauro Carvalho Chehab data[3] != SFE_VENDOR_DE_COMPANYID_0 || 184616300bdSMauro Carvalho Chehab data[4] != SFE_VENDOR_DE_COMPANYID_1 || 185616300bdSMauro Carvalho Chehab data[5] != SFE_VENDOR_DE_COMPANYID_2) 186616300bdSMauro Carvalho Chehab return "Vendor/Unknown"; 187616300bdSMauro Carvalho Chehab 188616300bdSMauro Carvalho Chehab switch (data[6]) { 189616300bdSMauro Carvalho Chehab case SFE_VENDOR_OPCODE_REGISTER_REMOTE_CONTROL: 190616300bdSMauro Carvalho Chehab return avc_debug & AVC_DEBUG_REGISTER_REMOTE_CONTROL ? 191616300bdSMauro Carvalho Chehab "RegisterRC" : NULL; 192616300bdSMauro Carvalho Chehab case SFE_VENDOR_OPCODE_LNB_CONTROL: 193616300bdSMauro Carvalho Chehab return avc_debug & AVC_DEBUG_LNB_CONTROL ? "LNBControl" : NULL; 194616300bdSMauro Carvalho Chehab case SFE_VENDOR_OPCODE_TUNE_QPSK: 195616300bdSMauro Carvalho Chehab return avc_debug & AVC_DEBUG_TUNE_QPSK ? "TuneQPSK" : NULL; 196616300bdSMauro Carvalho Chehab case SFE_VENDOR_OPCODE_TUNE_QPSK2: 197616300bdSMauro Carvalho Chehab return avc_debug & AVC_DEBUG_TUNE_QPSK2 ? "TuneQPSK2" : NULL; 198616300bdSMauro Carvalho Chehab case SFE_VENDOR_OPCODE_HOST2CA: 199616300bdSMauro Carvalho Chehab return avc_debug & AVC_DEBUG_HOST2CA ? "Host2CA" : NULL; 200616300bdSMauro Carvalho Chehab case SFE_VENDOR_OPCODE_CA2HOST: 201616300bdSMauro Carvalho Chehab return avc_debug & AVC_DEBUG_CA2HOST ? "CA2Host" : NULL; 202616300bdSMauro Carvalho Chehab } 203616300bdSMauro Carvalho Chehab return "Vendor/Unknown"; 204616300bdSMauro Carvalho Chehab } 205616300bdSMauro Carvalho Chehab 206616300bdSMauro Carvalho Chehab static void debug_fcp(const u8 *data, int length) 207616300bdSMauro Carvalho Chehab { 208616300bdSMauro Carvalho Chehab unsigned int subunit_type, subunit_id, opcode; 209616300bdSMauro Carvalho Chehab const char *op, *prefix; 210616300bdSMauro Carvalho Chehab 211616300bdSMauro Carvalho Chehab prefix = data[0] > 7 ? "FCP <- " : "FCP -> "; 212616300bdSMauro Carvalho Chehab subunit_type = data[1] >> 3; 213616300bdSMauro Carvalho Chehab subunit_id = data[1] & 7; 214616300bdSMauro Carvalho Chehab opcode = subunit_type == 0x1e || subunit_id == 5 ? ~0 : data[2]; 215616300bdSMauro Carvalho Chehab op = debug_fcp_opcode(opcode, data, length); 216616300bdSMauro Carvalho Chehab 217616300bdSMauro Carvalho Chehab if (op) { 218616300bdSMauro Carvalho Chehab printk(KERN_INFO "%ssu=%x.%x l=%d: %-8s - %s\n", 219616300bdSMauro Carvalho Chehab prefix, subunit_type, subunit_id, length, 220616300bdSMauro Carvalho Chehab debug_fcp_ctype(data[0]), op); 221616300bdSMauro Carvalho Chehab if (avc_debug & AVC_DEBUG_FCP_PAYLOADS) 222616300bdSMauro Carvalho Chehab print_hex_dump(KERN_INFO, prefix, DUMP_PREFIX_NONE, 223616300bdSMauro Carvalho Chehab 16, 1, data, length, false); 224616300bdSMauro Carvalho Chehab } 225616300bdSMauro Carvalho Chehab } 226616300bdSMauro Carvalho Chehab 227616300bdSMauro Carvalho Chehab static void debug_pmt(char *msg, int length) 228616300bdSMauro Carvalho Chehab { 229616300bdSMauro Carvalho Chehab printk(KERN_INFO "APP PMT -> l=%d\n", length); 230616300bdSMauro Carvalho Chehab print_hex_dump(KERN_INFO, "APP PMT -> ", DUMP_PREFIX_NONE, 231616300bdSMauro Carvalho Chehab 16, 1, msg, length, false); 232616300bdSMauro Carvalho Chehab } 233616300bdSMauro Carvalho Chehab 234616300bdSMauro Carvalho Chehab static int avc_write(struct firedtv *fdtv) 235616300bdSMauro Carvalho Chehab { 236616300bdSMauro Carvalho Chehab int err, retry; 237616300bdSMauro Carvalho Chehab 238616300bdSMauro Carvalho Chehab fdtv->avc_reply_received = false; 239616300bdSMauro Carvalho Chehab 240616300bdSMauro Carvalho Chehab for (retry = 0; retry < 6; retry++) { 241616300bdSMauro Carvalho Chehab if (unlikely(avc_debug)) 242616300bdSMauro Carvalho Chehab debug_fcp(fdtv->avc_data, fdtv->avc_data_length); 243616300bdSMauro Carvalho Chehab 244616300bdSMauro Carvalho Chehab err = fdtv_write(fdtv, FCP_COMMAND_REGISTER, 245616300bdSMauro Carvalho Chehab fdtv->avc_data, fdtv->avc_data_length); 246616300bdSMauro Carvalho Chehab if (err) { 247616300bdSMauro Carvalho Chehab dev_err(fdtv->device, "FCP command write failed\n"); 248616300bdSMauro Carvalho Chehab 249616300bdSMauro Carvalho Chehab return err; 250616300bdSMauro Carvalho Chehab } 251616300bdSMauro Carvalho Chehab 252616300bdSMauro Carvalho Chehab /* 253616300bdSMauro Carvalho Chehab * AV/C specs say that answers should be sent within 150 ms. 254616300bdSMauro Carvalho Chehab * Time out after 200 ms. 255616300bdSMauro Carvalho Chehab */ 256616300bdSMauro Carvalho Chehab if (wait_event_timeout(fdtv->avc_wait, 257616300bdSMauro Carvalho Chehab fdtv->avc_reply_received, 258616300bdSMauro Carvalho Chehab msecs_to_jiffies(200)) != 0) 259616300bdSMauro Carvalho Chehab return 0; 260616300bdSMauro Carvalho Chehab } 261616300bdSMauro Carvalho Chehab dev_err(fdtv->device, "FCP response timed out\n"); 262616300bdSMauro Carvalho Chehab 263616300bdSMauro Carvalho Chehab return -ETIMEDOUT; 264616300bdSMauro Carvalho Chehab } 265616300bdSMauro Carvalho Chehab 266616300bdSMauro Carvalho Chehab static bool is_register_rc(struct avc_response_frame *r) 267616300bdSMauro Carvalho Chehab { 268616300bdSMauro Carvalho Chehab return r->opcode == AVC_OPCODE_VENDOR && 269616300bdSMauro Carvalho Chehab r->operand[0] == SFE_VENDOR_DE_COMPANYID_0 && 270616300bdSMauro Carvalho Chehab r->operand[1] == SFE_VENDOR_DE_COMPANYID_1 && 271616300bdSMauro Carvalho Chehab r->operand[2] == SFE_VENDOR_DE_COMPANYID_2 && 272616300bdSMauro Carvalho Chehab r->operand[3] == SFE_VENDOR_OPCODE_REGISTER_REMOTE_CONTROL; 273616300bdSMauro Carvalho Chehab } 274616300bdSMauro Carvalho Chehab 275616300bdSMauro Carvalho Chehab int avc_recv(struct firedtv *fdtv, void *data, size_t length) 276616300bdSMauro Carvalho Chehab { 277616300bdSMauro Carvalho Chehab struct avc_response_frame *r = data; 278616300bdSMauro Carvalho Chehab 279616300bdSMauro Carvalho Chehab if (unlikely(avc_debug)) 280616300bdSMauro Carvalho Chehab debug_fcp(data, length); 281616300bdSMauro Carvalho Chehab 282616300bdSMauro Carvalho Chehab if (length >= 8 && is_register_rc(r)) { 283616300bdSMauro Carvalho Chehab switch (r->response) { 284616300bdSMauro Carvalho Chehab case AVC_RESPONSE_CHANGED: 285616300bdSMauro Carvalho Chehab fdtv_handle_rc(fdtv, r->operand[4] << 8 | r->operand[5]); 286616300bdSMauro Carvalho Chehab schedule_work(&fdtv->remote_ctrl_work); 287616300bdSMauro Carvalho Chehab break; 288616300bdSMauro Carvalho Chehab case AVC_RESPONSE_INTERIM: 289616300bdSMauro Carvalho Chehab if (is_register_rc((void *)fdtv->avc_data)) 290616300bdSMauro Carvalho Chehab goto wake; 291616300bdSMauro Carvalho Chehab break; 292616300bdSMauro Carvalho Chehab default: 293616300bdSMauro Carvalho Chehab dev_info(fdtv->device, 294616300bdSMauro Carvalho Chehab "remote control result = %d\n", r->response); 295616300bdSMauro Carvalho Chehab } 296616300bdSMauro Carvalho Chehab return 0; 297616300bdSMauro Carvalho Chehab } 298616300bdSMauro Carvalho Chehab 299616300bdSMauro Carvalho Chehab if (fdtv->avc_reply_received) { 300616300bdSMauro Carvalho Chehab dev_err(fdtv->device, "out-of-order AVC response, ignored\n"); 301616300bdSMauro Carvalho Chehab return -EIO; 302616300bdSMauro Carvalho Chehab } 303616300bdSMauro Carvalho Chehab 304616300bdSMauro Carvalho Chehab memcpy(fdtv->avc_data, data, length); 305616300bdSMauro Carvalho Chehab fdtv->avc_data_length = length; 306616300bdSMauro Carvalho Chehab wake: 307616300bdSMauro Carvalho Chehab fdtv->avc_reply_received = true; 308616300bdSMauro Carvalho Chehab wake_up(&fdtv->avc_wait); 309616300bdSMauro Carvalho Chehab 310616300bdSMauro Carvalho Chehab return 0; 311616300bdSMauro Carvalho Chehab } 312616300bdSMauro Carvalho Chehab 313616300bdSMauro Carvalho Chehab static int add_pid_filter(struct firedtv *fdtv, u8 *operand) 314616300bdSMauro Carvalho Chehab { 315616300bdSMauro Carvalho Chehab int i, n, pos = 1; 316616300bdSMauro Carvalho Chehab 317616300bdSMauro Carvalho Chehab for (i = 0, n = 0; i < 16; i++) { 318616300bdSMauro Carvalho Chehab if (test_bit(i, &fdtv->channel_active)) { 319616300bdSMauro Carvalho Chehab operand[pos++] = 0x13; /* flowfunction relay */ 320616300bdSMauro Carvalho Chehab operand[pos++] = 0x80; /* dsd_sel_spec_valid_flags -> PID */ 321616300bdSMauro Carvalho Chehab operand[pos++] = (fdtv->channel_pid[i] >> 8) & 0x1f; 322616300bdSMauro Carvalho Chehab operand[pos++] = fdtv->channel_pid[i] & 0xff; 323616300bdSMauro Carvalho Chehab operand[pos++] = 0x00; /* tableID */ 324616300bdSMauro Carvalho Chehab operand[pos++] = 0x00; /* filter_length */ 325616300bdSMauro Carvalho Chehab n++; 326616300bdSMauro Carvalho Chehab } 327616300bdSMauro Carvalho Chehab } 328616300bdSMauro Carvalho Chehab operand[0] = n; 329616300bdSMauro Carvalho Chehab 330616300bdSMauro Carvalho Chehab return pos; 331616300bdSMauro Carvalho Chehab } 332616300bdSMauro Carvalho Chehab 333616300bdSMauro Carvalho Chehab /* 334616300bdSMauro Carvalho Chehab * tuning command for setting the relative LNB frequency 335616300bdSMauro Carvalho Chehab * (not supported by the AVC standard) 336616300bdSMauro Carvalho Chehab */ 337616300bdSMauro Carvalho Chehab static int avc_tuner_tuneqpsk(struct firedtv *fdtv, 338616300bdSMauro Carvalho Chehab struct dtv_frontend_properties *p) 339616300bdSMauro Carvalho Chehab { 340616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 341616300bdSMauro Carvalho Chehab 342616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_VENDOR; 343616300bdSMauro Carvalho Chehab 344616300bdSMauro Carvalho Chehab c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; 345616300bdSMauro Carvalho Chehab c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; 346616300bdSMauro Carvalho Chehab c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; 347616300bdSMauro Carvalho Chehab if (fdtv->type == FIREDTV_DVB_S2) 348616300bdSMauro Carvalho Chehab c->operand[3] = SFE_VENDOR_OPCODE_TUNE_QPSK2; 349616300bdSMauro Carvalho Chehab else 350616300bdSMauro Carvalho Chehab c->operand[3] = SFE_VENDOR_OPCODE_TUNE_QPSK; 351616300bdSMauro Carvalho Chehab 352616300bdSMauro Carvalho Chehab c->operand[4] = (p->frequency >> 24) & 0xff; 353616300bdSMauro Carvalho Chehab c->operand[5] = (p->frequency >> 16) & 0xff; 354616300bdSMauro Carvalho Chehab c->operand[6] = (p->frequency >> 8) & 0xff; 355616300bdSMauro Carvalho Chehab c->operand[7] = p->frequency & 0xff; 356616300bdSMauro Carvalho Chehab 357616300bdSMauro Carvalho Chehab c->operand[8] = ((p->symbol_rate / 1000) >> 8) & 0xff; 358616300bdSMauro Carvalho Chehab c->operand[9] = (p->symbol_rate / 1000) & 0xff; 359616300bdSMauro Carvalho Chehab 360616300bdSMauro Carvalho Chehab switch (p->fec_inner) { 361616300bdSMauro Carvalho Chehab case FEC_1_2: c->operand[10] = 0x1; break; 362616300bdSMauro Carvalho Chehab case FEC_2_3: c->operand[10] = 0x2; break; 363616300bdSMauro Carvalho Chehab case FEC_3_4: c->operand[10] = 0x3; break; 364616300bdSMauro Carvalho Chehab case FEC_5_6: c->operand[10] = 0x4; break; 365616300bdSMauro Carvalho Chehab case FEC_7_8: c->operand[10] = 0x5; break; 366616300bdSMauro Carvalho Chehab case FEC_4_5: 367616300bdSMauro Carvalho Chehab case FEC_8_9: 368616300bdSMauro Carvalho Chehab case FEC_AUTO: 369616300bdSMauro Carvalho Chehab default: c->operand[10] = 0x0; 370616300bdSMauro Carvalho Chehab } 371616300bdSMauro Carvalho Chehab 372616300bdSMauro Carvalho Chehab if (fdtv->voltage == 0xff) 373616300bdSMauro Carvalho Chehab c->operand[11] = 0xff; 374616300bdSMauro Carvalho Chehab else if (fdtv->voltage == SEC_VOLTAGE_18) /* polarisation */ 375616300bdSMauro Carvalho Chehab c->operand[11] = 0; 376616300bdSMauro Carvalho Chehab else 377616300bdSMauro Carvalho Chehab c->operand[11] = 1; 378616300bdSMauro Carvalho Chehab 379616300bdSMauro Carvalho Chehab if (fdtv->tone == 0xff) 380616300bdSMauro Carvalho Chehab c->operand[12] = 0xff; 381616300bdSMauro Carvalho Chehab else if (fdtv->tone == SEC_TONE_ON) /* band */ 382616300bdSMauro Carvalho Chehab c->operand[12] = 1; 383616300bdSMauro Carvalho Chehab else 384616300bdSMauro Carvalho Chehab c->operand[12] = 0; 385616300bdSMauro Carvalho Chehab 386616300bdSMauro Carvalho Chehab if (fdtv->type == FIREDTV_DVB_S2) { 387616300bdSMauro Carvalho Chehab if (fdtv->fe.dtv_property_cache.delivery_system == SYS_DVBS2) { 388616300bdSMauro Carvalho Chehab switch (fdtv->fe.dtv_property_cache.modulation) { 389616300bdSMauro Carvalho Chehab case QAM_16: c->operand[13] = 0x1; break; 390616300bdSMauro Carvalho Chehab case QPSK: c->operand[13] = 0x2; break; 391616300bdSMauro Carvalho Chehab case PSK_8: c->operand[13] = 0x3; break; 392616300bdSMauro Carvalho Chehab default: c->operand[13] = 0x2; break; 393616300bdSMauro Carvalho Chehab } 394616300bdSMauro Carvalho Chehab switch (fdtv->fe.dtv_property_cache.rolloff) { 395616300bdSMauro Carvalho Chehab case ROLLOFF_35: c->operand[14] = 0x2; break; 396616300bdSMauro Carvalho Chehab case ROLLOFF_20: c->operand[14] = 0x0; break; 397616300bdSMauro Carvalho Chehab case ROLLOFF_25: c->operand[14] = 0x1; break; 398616300bdSMauro Carvalho Chehab case ROLLOFF_AUTO: 399616300bdSMauro Carvalho Chehab default: c->operand[14] = 0x2; break; 400616300bdSMauro Carvalho Chehab /* case ROLLOFF_NONE: c->operand[14] = 0xff; break; */ 401616300bdSMauro Carvalho Chehab } 402616300bdSMauro Carvalho Chehab switch (fdtv->fe.dtv_property_cache.pilot) { 403616300bdSMauro Carvalho Chehab case PILOT_AUTO: c->operand[15] = 0x0; break; 404616300bdSMauro Carvalho Chehab case PILOT_OFF: c->operand[15] = 0x0; break; 405616300bdSMauro Carvalho Chehab case PILOT_ON: c->operand[15] = 0x1; break; 406616300bdSMauro Carvalho Chehab } 407616300bdSMauro Carvalho Chehab } else { 408616300bdSMauro Carvalho Chehab c->operand[13] = 0x1; /* auto modulation */ 409616300bdSMauro Carvalho Chehab c->operand[14] = 0xff; /* disable rolloff */ 410616300bdSMauro Carvalho Chehab c->operand[15] = 0xff; /* disable pilot */ 411616300bdSMauro Carvalho Chehab } 412616300bdSMauro Carvalho Chehab return 16; 413616300bdSMauro Carvalho Chehab } else { 414616300bdSMauro Carvalho Chehab return 13; 415616300bdSMauro Carvalho Chehab } 416616300bdSMauro Carvalho Chehab } 417616300bdSMauro Carvalho Chehab 418616300bdSMauro Carvalho Chehab static int avc_tuner_dsd_dvb_c(struct firedtv *fdtv, 419616300bdSMauro Carvalho Chehab struct dtv_frontend_properties *p) 420616300bdSMauro Carvalho Chehab { 421616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 422616300bdSMauro Carvalho Chehab 423616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_DSD; 424616300bdSMauro Carvalho Chehab 425616300bdSMauro Carvalho Chehab c->operand[0] = 0; /* source plug */ 426616300bdSMauro Carvalho Chehab c->operand[1] = 0xd2; /* subfunction replace */ 427616300bdSMauro Carvalho Chehab c->operand[2] = 0x20; /* system id = DVB */ 428616300bdSMauro Carvalho Chehab c->operand[3] = 0x00; /* antenna number */ 429616300bdSMauro Carvalho Chehab c->operand[4] = 0x11; /* system_specific_multiplex selection_length */ 430616300bdSMauro Carvalho Chehab 431616300bdSMauro Carvalho Chehab /* multiplex_valid_flags, high byte */ 432616300bdSMauro Carvalho Chehab c->operand[5] = 0 << 7 /* reserved */ 433616300bdSMauro Carvalho Chehab | 0 << 6 /* Polarisation */ 434616300bdSMauro Carvalho Chehab | 0 << 5 /* Orbital_Pos */ 435616300bdSMauro Carvalho Chehab | 1 << 4 /* Frequency */ 436616300bdSMauro Carvalho Chehab | 1 << 3 /* Symbol_Rate */ 437616300bdSMauro Carvalho Chehab | 0 << 2 /* FEC_outer */ 438616300bdSMauro Carvalho Chehab | (p->fec_inner != FEC_AUTO ? 1 << 1 : 0) 439616300bdSMauro Carvalho Chehab | (p->modulation != QAM_AUTO ? 1 << 0 : 0); 440616300bdSMauro Carvalho Chehab 441616300bdSMauro Carvalho Chehab /* multiplex_valid_flags, low byte */ 442616300bdSMauro Carvalho Chehab c->operand[6] = 0 << 7 /* NetworkID */ 443616300bdSMauro Carvalho Chehab | 0 << 0 /* reserved */ ; 444616300bdSMauro Carvalho Chehab 445616300bdSMauro Carvalho Chehab c->operand[7] = 0x00; 446616300bdSMauro Carvalho Chehab c->operand[8] = 0x00; 447616300bdSMauro Carvalho Chehab c->operand[9] = 0x00; 448616300bdSMauro Carvalho Chehab c->operand[10] = 0x00; 449616300bdSMauro Carvalho Chehab 450616300bdSMauro Carvalho Chehab c->operand[11] = (((p->frequency / 4000) >> 16) & 0xff) | (2 << 6); 451616300bdSMauro Carvalho Chehab c->operand[12] = ((p->frequency / 4000) >> 8) & 0xff; 452616300bdSMauro Carvalho Chehab c->operand[13] = (p->frequency / 4000) & 0xff; 453616300bdSMauro Carvalho Chehab c->operand[14] = ((p->symbol_rate / 1000) >> 12) & 0xff; 454616300bdSMauro Carvalho Chehab c->operand[15] = ((p->symbol_rate / 1000) >> 4) & 0xff; 455616300bdSMauro Carvalho Chehab c->operand[16] = ((p->symbol_rate / 1000) << 4) & 0xf0; 456616300bdSMauro Carvalho Chehab c->operand[17] = 0x00; 457616300bdSMauro Carvalho Chehab 458616300bdSMauro Carvalho Chehab switch (p->fec_inner) { 459616300bdSMauro Carvalho Chehab case FEC_1_2: c->operand[18] = 0x1; break; 460616300bdSMauro Carvalho Chehab case FEC_2_3: c->operand[18] = 0x2; break; 461616300bdSMauro Carvalho Chehab case FEC_3_4: c->operand[18] = 0x3; break; 462616300bdSMauro Carvalho Chehab case FEC_5_6: c->operand[18] = 0x4; break; 463616300bdSMauro Carvalho Chehab case FEC_7_8: c->operand[18] = 0x5; break; 464616300bdSMauro Carvalho Chehab case FEC_8_9: c->operand[18] = 0x6; break; 465616300bdSMauro Carvalho Chehab case FEC_4_5: c->operand[18] = 0x8; break; 466616300bdSMauro Carvalho Chehab case FEC_AUTO: 467616300bdSMauro Carvalho Chehab default: c->operand[18] = 0x0; 468616300bdSMauro Carvalho Chehab } 469616300bdSMauro Carvalho Chehab 470616300bdSMauro Carvalho Chehab switch (p->modulation) { 471616300bdSMauro Carvalho Chehab case QAM_16: c->operand[19] = 0x08; break; 472616300bdSMauro Carvalho Chehab case QAM_32: c->operand[19] = 0x10; break; 473616300bdSMauro Carvalho Chehab case QAM_64: c->operand[19] = 0x18; break; 474616300bdSMauro Carvalho Chehab case QAM_128: c->operand[19] = 0x20; break; 475616300bdSMauro Carvalho Chehab case QAM_256: c->operand[19] = 0x28; break; 476616300bdSMauro Carvalho Chehab case QAM_AUTO: 477616300bdSMauro Carvalho Chehab default: c->operand[19] = 0x00; 478616300bdSMauro Carvalho Chehab } 479616300bdSMauro Carvalho Chehab 480616300bdSMauro Carvalho Chehab c->operand[20] = 0x00; 481616300bdSMauro Carvalho Chehab c->operand[21] = 0x00; 482616300bdSMauro Carvalho Chehab 483616300bdSMauro Carvalho Chehab return 22 + add_pid_filter(fdtv, &c->operand[22]); 484616300bdSMauro Carvalho Chehab } 485616300bdSMauro Carvalho Chehab 486616300bdSMauro Carvalho Chehab static int avc_tuner_dsd_dvb_t(struct firedtv *fdtv, 487616300bdSMauro Carvalho Chehab struct dtv_frontend_properties *p) 488616300bdSMauro Carvalho Chehab { 489616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 490616300bdSMauro Carvalho Chehab 491616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_DSD; 492616300bdSMauro Carvalho Chehab 493616300bdSMauro Carvalho Chehab c->operand[0] = 0; /* source plug */ 494616300bdSMauro Carvalho Chehab c->operand[1] = 0xd2; /* subfunction replace */ 495616300bdSMauro Carvalho Chehab c->operand[2] = 0x20; /* system id = DVB */ 496616300bdSMauro Carvalho Chehab c->operand[3] = 0x00; /* antenna number */ 497616300bdSMauro Carvalho Chehab c->operand[4] = 0x0c; /* system_specific_multiplex selection_length */ 498616300bdSMauro Carvalho Chehab 499616300bdSMauro Carvalho Chehab /* multiplex_valid_flags, high byte */ 500616300bdSMauro Carvalho Chehab c->operand[5] = 501616300bdSMauro Carvalho Chehab 0 << 7 /* reserved */ 502616300bdSMauro Carvalho Chehab | 1 << 6 /* CenterFrequency */ 503616300bdSMauro Carvalho Chehab | (p->bandwidth_hz != 0 ? 1 << 5 : 0) 504616300bdSMauro Carvalho Chehab | (p->modulation != QAM_AUTO ? 1 << 4 : 0) 505616300bdSMauro Carvalho Chehab | (p->hierarchy != HIERARCHY_AUTO ? 1 << 3 : 0) 506616300bdSMauro Carvalho Chehab | (p->code_rate_HP != FEC_AUTO ? 1 << 2 : 0) 507616300bdSMauro Carvalho Chehab | (p->code_rate_LP != FEC_AUTO ? 1 << 1 : 0) 508616300bdSMauro Carvalho Chehab | (p->guard_interval != GUARD_INTERVAL_AUTO ? 1 << 0 : 0); 509616300bdSMauro Carvalho Chehab 510616300bdSMauro Carvalho Chehab /* multiplex_valid_flags, low byte */ 511616300bdSMauro Carvalho Chehab c->operand[6] = 512616300bdSMauro Carvalho Chehab 0 << 7 /* NetworkID */ 513616300bdSMauro Carvalho Chehab | (p->transmission_mode != TRANSMISSION_MODE_AUTO ? 1 << 6 : 0) 514616300bdSMauro Carvalho Chehab | 0 << 5 /* OtherFrequencyFlag */ 515616300bdSMauro Carvalho Chehab | 0 << 0 /* reserved */ ; 516616300bdSMauro Carvalho Chehab 517616300bdSMauro Carvalho Chehab c->operand[7] = 0x0; 518616300bdSMauro Carvalho Chehab c->operand[8] = (p->frequency / 10) >> 24; 519616300bdSMauro Carvalho Chehab c->operand[9] = ((p->frequency / 10) >> 16) & 0xff; 520616300bdSMauro Carvalho Chehab c->operand[10] = ((p->frequency / 10) >> 8) & 0xff; 521616300bdSMauro Carvalho Chehab c->operand[11] = (p->frequency / 10) & 0xff; 522616300bdSMauro Carvalho Chehab 523616300bdSMauro Carvalho Chehab switch (p->bandwidth_hz) { 524616300bdSMauro Carvalho Chehab case 7000000: c->operand[12] = 0x20; break; 525616300bdSMauro Carvalho Chehab case 8000000: 526616300bdSMauro Carvalho Chehab case 6000000: /* not defined by AVC spec */ 527616300bdSMauro Carvalho Chehab case 0: 528616300bdSMauro Carvalho Chehab default: c->operand[12] = 0x00; 529616300bdSMauro Carvalho Chehab } 530616300bdSMauro Carvalho Chehab 531616300bdSMauro Carvalho Chehab switch (p->modulation) { 532616300bdSMauro Carvalho Chehab case QAM_16: c->operand[13] = 1 << 6; break; 533616300bdSMauro Carvalho Chehab case QAM_64: c->operand[13] = 2 << 6; break; 534616300bdSMauro Carvalho Chehab case QPSK: 535616300bdSMauro Carvalho Chehab default: c->operand[13] = 0x00; 536616300bdSMauro Carvalho Chehab } 537616300bdSMauro Carvalho Chehab 538616300bdSMauro Carvalho Chehab switch (p->hierarchy) { 539616300bdSMauro Carvalho Chehab case HIERARCHY_1: c->operand[13] |= 1 << 3; break; 540616300bdSMauro Carvalho Chehab case HIERARCHY_2: c->operand[13] |= 2 << 3; break; 541616300bdSMauro Carvalho Chehab case HIERARCHY_4: c->operand[13] |= 3 << 3; break; 542616300bdSMauro Carvalho Chehab case HIERARCHY_AUTO: 543616300bdSMauro Carvalho Chehab case HIERARCHY_NONE: 544616300bdSMauro Carvalho Chehab default: break; 545616300bdSMauro Carvalho Chehab } 546616300bdSMauro Carvalho Chehab 547616300bdSMauro Carvalho Chehab switch (p->code_rate_HP) { 548616300bdSMauro Carvalho Chehab case FEC_2_3: c->operand[13] |= 1; break; 549616300bdSMauro Carvalho Chehab case FEC_3_4: c->operand[13] |= 2; break; 550616300bdSMauro Carvalho Chehab case FEC_5_6: c->operand[13] |= 3; break; 551616300bdSMauro Carvalho Chehab case FEC_7_8: c->operand[13] |= 4; break; 552616300bdSMauro Carvalho Chehab case FEC_1_2: 553616300bdSMauro Carvalho Chehab default: break; 554616300bdSMauro Carvalho Chehab } 555616300bdSMauro Carvalho Chehab 556616300bdSMauro Carvalho Chehab switch (p->code_rate_LP) { 557616300bdSMauro Carvalho Chehab case FEC_2_3: c->operand[14] = 1 << 5; break; 558616300bdSMauro Carvalho Chehab case FEC_3_4: c->operand[14] = 2 << 5; break; 559616300bdSMauro Carvalho Chehab case FEC_5_6: c->operand[14] = 3 << 5; break; 560616300bdSMauro Carvalho Chehab case FEC_7_8: c->operand[14] = 4 << 5; break; 561616300bdSMauro Carvalho Chehab case FEC_1_2: 562616300bdSMauro Carvalho Chehab default: c->operand[14] = 0x00; break; 563616300bdSMauro Carvalho Chehab } 564616300bdSMauro Carvalho Chehab 565616300bdSMauro Carvalho Chehab switch (p->guard_interval) { 566616300bdSMauro Carvalho Chehab case GUARD_INTERVAL_1_16: c->operand[14] |= 1 << 3; break; 567616300bdSMauro Carvalho Chehab case GUARD_INTERVAL_1_8: c->operand[14] |= 2 << 3; break; 568616300bdSMauro Carvalho Chehab case GUARD_INTERVAL_1_4: c->operand[14] |= 3 << 3; break; 569616300bdSMauro Carvalho Chehab case GUARD_INTERVAL_1_32: 570616300bdSMauro Carvalho Chehab case GUARD_INTERVAL_AUTO: 571616300bdSMauro Carvalho Chehab default: break; 572616300bdSMauro Carvalho Chehab } 573616300bdSMauro Carvalho Chehab 574616300bdSMauro Carvalho Chehab switch (p->transmission_mode) { 575616300bdSMauro Carvalho Chehab case TRANSMISSION_MODE_8K: c->operand[14] |= 1 << 1; break; 576616300bdSMauro Carvalho Chehab case TRANSMISSION_MODE_2K: 577616300bdSMauro Carvalho Chehab case TRANSMISSION_MODE_AUTO: 578616300bdSMauro Carvalho Chehab default: break; 579616300bdSMauro Carvalho Chehab } 580616300bdSMauro Carvalho Chehab 581616300bdSMauro Carvalho Chehab c->operand[15] = 0x00; /* network_ID[0] */ 582616300bdSMauro Carvalho Chehab c->operand[16] = 0x00; /* network_ID[1] */ 583616300bdSMauro Carvalho Chehab 584616300bdSMauro Carvalho Chehab return 17 + add_pid_filter(fdtv, &c->operand[17]); 585616300bdSMauro Carvalho Chehab } 586616300bdSMauro Carvalho Chehab 587616300bdSMauro Carvalho Chehab int avc_tuner_dsd(struct firedtv *fdtv, 588616300bdSMauro Carvalho Chehab struct dtv_frontend_properties *p) 589616300bdSMauro Carvalho Chehab { 590616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 591616300bdSMauro Carvalho Chehab int pos, ret; 592616300bdSMauro Carvalho Chehab 593616300bdSMauro Carvalho Chehab mutex_lock(&fdtv->avc_mutex); 594616300bdSMauro Carvalho Chehab 595616300bdSMauro Carvalho Chehab c->ctype = AVC_CTYPE_CONTROL; 596616300bdSMauro Carvalho Chehab c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; 597616300bdSMauro Carvalho Chehab 598616300bdSMauro Carvalho Chehab switch (fdtv->type) { 599616300bdSMauro Carvalho Chehab case FIREDTV_DVB_S: 600616300bdSMauro Carvalho Chehab case FIREDTV_DVB_S2: pos = avc_tuner_tuneqpsk(fdtv, p); break; 601616300bdSMauro Carvalho Chehab case FIREDTV_DVB_C: pos = avc_tuner_dsd_dvb_c(fdtv, p); break; 602616300bdSMauro Carvalho Chehab case FIREDTV_DVB_T: pos = avc_tuner_dsd_dvb_t(fdtv, p); break; 603616300bdSMauro Carvalho Chehab default: 604616300bdSMauro Carvalho Chehab BUG(); 605616300bdSMauro Carvalho Chehab } 606616300bdSMauro Carvalho Chehab pad_operands(c, pos); 607616300bdSMauro Carvalho Chehab 608616300bdSMauro Carvalho Chehab fdtv->avc_data_length = ALIGN(3 + pos, 4); 609616300bdSMauro Carvalho Chehab ret = avc_write(fdtv); 610616300bdSMauro Carvalho Chehab #if 0 611616300bdSMauro Carvalho Chehab /* 612616300bdSMauro Carvalho Chehab * FIXME: 613616300bdSMauro Carvalho Chehab * u8 *status was an out-parameter of avc_tuner_dsd, unused by caller. 614616300bdSMauro Carvalho Chehab * Check for AVC_RESPONSE_ACCEPTED here instead? 615616300bdSMauro Carvalho Chehab */ 616616300bdSMauro Carvalho Chehab if (status) 617616300bdSMauro Carvalho Chehab *status = r->operand[2]; 618616300bdSMauro Carvalho Chehab #endif 619616300bdSMauro Carvalho Chehab mutex_unlock(&fdtv->avc_mutex); 620616300bdSMauro Carvalho Chehab 621616300bdSMauro Carvalho Chehab if (ret == 0) 622616300bdSMauro Carvalho Chehab msleep(500); 623616300bdSMauro Carvalho Chehab 624616300bdSMauro Carvalho Chehab return ret; 625616300bdSMauro Carvalho Chehab } 626616300bdSMauro Carvalho Chehab 627616300bdSMauro Carvalho Chehab int avc_tuner_set_pids(struct firedtv *fdtv, unsigned char pidc, u16 pid[]) 628616300bdSMauro Carvalho Chehab { 629616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 630616300bdSMauro Carvalho Chehab int ret, pos, k; 631616300bdSMauro Carvalho Chehab 632616300bdSMauro Carvalho Chehab if (pidc > 16 && pidc != 0xff) 633616300bdSMauro Carvalho Chehab return -EINVAL; 634616300bdSMauro Carvalho Chehab 635616300bdSMauro Carvalho Chehab mutex_lock(&fdtv->avc_mutex); 636616300bdSMauro Carvalho Chehab 637616300bdSMauro Carvalho Chehab c->ctype = AVC_CTYPE_CONTROL; 638616300bdSMauro Carvalho Chehab c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; 639616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_DSD; 640616300bdSMauro Carvalho Chehab 641616300bdSMauro Carvalho Chehab c->operand[0] = 0; /* source plug */ 642616300bdSMauro Carvalho Chehab c->operand[1] = 0xd2; /* subfunction replace */ 643616300bdSMauro Carvalho Chehab c->operand[2] = 0x20; /* system id = DVB */ 644616300bdSMauro Carvalho Chehab c->operand[3] = 0x00; /* antenna number */ 645616300bdSMauro Carvalho Chehab c->operand[4] = 0x00; /* system_specific_multiplex selection_length */ 646616300bdSMauro Carvalho Chehab c->operand[5] = pidc; /* Nr_of_dsd_sel_specs */ 647616300bdSMauro Carvalho Chehab 648616300bdSMauro Carvalho Chehab pos = 6; 649616300bdSMauro Carvalho Chehab if (pidc != 0xff) 650616300bdSMauro Carvalho Chehab for (k = 0; k < pidc; k++) { 651616300bdSMauro Carvalho Chehab c->operand[pos++] = 0x13; /* flowfunction relay */ 652616300bdSMauro Carvalho Chehab c->operand[pos++] = 0x80; /* dsd_sel_spec_valid_flags -> PID */ 653616300bdSMauro Carvalho Chehab c->operand[pos++] = (pid[k] >> 8) & 0x1f; 654616300bdSMauro Carvalho Chehab c->operand[pos++] = pid[k] & 0xff; 655616300bdSMauro Carvalho Chehab c->operand[pos++] = 0x00; /* tableID */ 656616300bdSMauro Carvalho Chehab c->operand[pos++] = 0x00; /* filter_length */ 657616300bdSMauro Carvalho Chehab } 658616300bdSMauro Carvalho Chehab pad_operands(c, pos); 659616300bdSMauro Carvalho Chehab 660616300bdSMauro Carvalho Chehab fdtv->avc_data_length = ALIGN(3 + pos, 4); 661616300bdSMauro Carvalho Chehab ret = avc_write(fdtv); 662616300bdSMauro Carvalho Chehab 663616300bdSMauro Carvalho Chehab /* FIXME: check response code? */ 664616300bdSMauro Carvalho Chehab 665616300bdSMauro Carvalho Chehab mutex_unlock(&fdtv->avc_mutex); 666616300bdSMauro Carvalho Chehab 667616300bdSMauro Carvalho Chehab if (ret == 0) 668616300bdSMauro Carvalho Chehab msleep(50); 669616300bdSMauro Carvalho Chehab 670616300bdSMauro Carvalho Chehab return ret; 671616300bdSMauro Carvalho Chehab } 672616300bdSMauro Carvalho Chehab 673616300bdSMauro Carvalho Chehab int avc_tuner_get_ts(struct firedtv *fdtv) 674616300bdSMauro Carvalho Chehab { 675616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 676616300bdSMauro Carvalho Chehab int ret, sl; 677616300bdSMauro Carvalho Chehab 678616300bdSMauro Carvalho Chehab mutex_lock(&fdtv->avc_mutex); 679616300bdSMauro Carvalho Chehab 680616300bdSMauro Carvalho Chehab c->ctype = AVC_CTYPE_CONTROL; 681616300bdSMauro Carvalho Chehab c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; 682616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_DSIT; 683616300bdSMauro Carvalho Chehab 684616300bdSMauro Carvalho Chehab sl = fdtv->type == FIREDTV_DVB_T ? 0x0c : 0x11; 685616300bdSMauro Carvalho Chehab 686616300bdSMauro Carvalho Chehab c->operand[0] = 0; /* source plug */ 687616300bdSMauro Carvalho Chehab c->operand[1] = 0xd2; /* subfunction replace */ 688616300bdSMauro Carvalho Chehab c->operand[2] = 0xff; /* status */ 689616300bdSMauro Carvalho Chehab c->operand[3] = 0x20; /* system id = DVB */ 690616300bdSMauro Carvalho Chehab c->operand[4] = 0x00; /* antenna number */ 691616300bdSMauro Carvalho Chehab c->operand[5] = 0x0; /* system_specific_search_flags */ 692616300bdSMauro Carvalho Chehab c->operand[6] = sl; /* system_specific_multiplex selection_length */ 693616300bdSMauro Carvalho Chehab /* 694616300bdSMauro Carvalho Chehab * operand[7]: valid_flags[0] 695616300bdSMauro Carvalho Chehab * operand[8]: valid_flags[1] 696616300bdSMauro Carvalho Chehab * operand[7 + sl]: nr_of_dsit_sel_specs (always 0) 697616300bdSMauro Carvalho Chehab */ 698616300bdSMauro Carvalho Chehab clear_operands(c, 7, 24); 699616300bdSMauro Carvalho Chehab 700616300bdSMauro Carvalho Chehab fdtv->avc_data_length = fdtv->type == FIREDTV_DVB_T ? 24 : 28; 701616300bdSMauro Carvalho Chehab ret = avc_write(fdtv); 702616300bdSMauro Carvalho Chehab 703616300bdSMauro Carvalho Chehab /* FIXME: check response code? */ 704616300bdSMauro Carvalho Chehab 705616300bdSMauro Carvalho Chehab mutex_unlock(&fdtv->avc_mutex); 706616300bdSMauro Carvalho Chehab 707616300bdSMauro Carvalho Chehab if (ret == 0) 708616300bdSMauro Carvalho Chehab msleep(250); 709616300bdSMauro Carvalho Chehab 710616300bdSMauro Carvalho Chehab return ret; 711616300bdSMauro Carvalho Chehab } 712616300bdSMauro Carvalho Chehab 713616300bdSMauro Carvalho Chehab int avc_identify_subunit(struct firedtv *fdtv) 714616300bdSMauro Carvalho Chehab { 715616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 716616300bdSMauro Carvalho Chehab struct avc_response_frame *r = (void *)fdtv->avc_data; 717616300bdSMauro Carvalho Chehab int ret; 718616300bdSMauro Carvalho Chehab 719616300bdSMauro Carvalho Chehab mutex_lock(&fdtv->avc_mutex); 720616300bdSMauro Carvalho Chehab 721616300bdSMauro Carvalho Chehab c->ctype = AVC_CTYPE_CONTROL; 722616300bdSMauro Carvalho Chehab c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; 723616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_READ_DESCRIPTOR; 724616300bdSMauro Carvalho Chehab 725616300bdSMauro Carvalho Chehab c->operand[0] = DESCRIPTOR_SUBUNIT_IDENTIFIER; 726616300bdSMauro Carvalho Chehab c->operand[1] = 0xff; 727616300bdSMauro Carvalho Chehab c->operand[2] = 0x00; 728616300bdSMauro Carvalho Chehab c->operand[3] = 0x00; /* length highbyte */ 729616300bdSMauro Carvalho Chehab c->operand[4] = 0x08; /* length lowbyte */ 730616300bdSMauro Carvalho Chehab c->operand[5] = 0x00; /* offset highbyte */ 731616300bdSMauro Carvalho Chehab c->operand[6] = 0x0d; /* offset lowbyte */ 732616300bdSMauro Carvalho Chehab clear_operands(c, 7, 8); /* padding */ 733616300bdSMauro Carvalho Chehab 734616300bdSMauro Carvalho Chehab fdtv->avc_data_length = 12; 735616300bdSMauro Carvalho Chehab ret = avc_write(fdtv); 736616300bdSMauro Carvalho Chehab if (ret < 0) 737616300bdSMauro Carvalho Chehab goto out; 738616300bdSMauro Carvalho Chehab 739616300bdSMauro Carvalho Chehab if ((r->response != AVC_RESPONSE_STABLE && 740616300bdSMauro Carvalho Chehab r->response != AVC_RESPONSE_ACCEPTED) || 741616300bdSMauro Carvalho Chehab (r->operand[3] << 8) + r->operand[4] != 8) { 742616300bdSMauro Carvalho Chehab dev_err(fdtv->device, "cannot read subunit identifier\n"); 743616300bdSMauro Carvalho Chehab ret = -EINVAL; 744616300bdSMauro Carvalho Chehab } 745616300bdSMauro Carvalho Chehab out: 746616300bdSMauro Carvalho Chehab mutex_unlock(&fdtv->avc_mutex); 747616300bdSMauro Carvalho Chehab 748616300bdSMauro Carvalho Chehab return ret; 749616300bdSMauro Carvalho Chehab } 750616300bdSMauro Carvalho Chehab 751616300bdSMauro Carvalho Chehab #define SIZEOF_ANTENNA_INPUT_INFO 22 752616300bdSMauro Carvalho Chehab 753616300bdSMauro Carvalho Chehab int avc_tuner_status(struct firedtv *fdtv, struct firedtv_tuner_status *stat) 754616300bdSMauro Carvalho Chehab { 755616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 756616300bdSMauro Carvalho Chehab struct avc_response_frame *r = (void *)fdtv->avc_data; 757616300bdSMauro Carvalho Chehab int length, ret; 758616300bdSMauro Carvalho Chehab 759616300bdSMauro Carvalho Chehab mutex_lock(&fdtv->avc_mutex); 760616300bdSMauro Carvalho Chehab 761616300bdSMauro Carvalho Chehab c->ctype = AVC_CTYPE_CONTROL; 762616300bdSMauro Carvalho Chehab c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; 763616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_READ_DESCRIPTOR; 764616300bdSMauro Carvalho Chehab 765616300bdSMauro Carvalho Chehab c->operand[0] = DESCRIPTOR_TUNER_STATUS; 766616300bdSMauro Carvalho Chehab c->operand[1] = 0xff; /* read_result_status */ 767616300bdSMauro Carvalho Chehab /* 768616300bdSMauro Carvalho Chehab * operand[2]: reserved 769616300bdSMauro Carvalho Chehab * operand[3]: SIZEOF_ANTENNA_INPUT_INFO >> 8 770616300bdSMauro Carvalho Chehab * operand[4]: SIZEOF_ANTENNA_INPUT_INFO & 0xff 771616300bdSMauro Carvalho Chehab */ 772616300bdSMauro Carvalho Chehab clear_operands(c, 2, 31); 773616300bdSMauro Carvalho Chehab 774616300bdSMauro Carvalho Chehab fdtv->avc_data_length = 12; 775616300bdSMauro Carvalho Chehab ret = avc_write(fdtv); 776616300bdSMauro Carvalho Chehab if (ret < 0) 777616300bdSMauro Carvalho Chehab goto out; 778616300bdSMauro Carvalho Chehab 779616300bdSMauro Carvalho Chehab if (r->response != AVC_RESPONSE_STABLE && 780616300bdSMauro Carvalho Chehab r->response != AVC_RESPONSE_ACCEPTED) { 781616300bdSMauro Carvalho Chehab dev_err(fdtv->device, "cannot read tuner status\n"); 782616300bdSMauro Carvalho Chehab ret = -EINVAL; 783616300bdSMauro Carvalho Chehab goto out; 784616300bdSMauro Carvalho Chehab } 785616300bdSMauro Carvalho Chehab 786616300bdSMauro Carvalho Chehab length = r->operand[9]; 787616300bdSMauro Carvalho Chehab if (r->operand[1] != 0x10 || length != SIZEOF_ANTENNA_INPUT_INFO) { 788616300bdSMauro Carvalho Chehab dev_err(fdtv->device, "got invalid tuner status\n"); 789616300bdSMauro Carvalho Chehab ret = -EINVAL; 790616300bdSMauro Carvalho Chehab goto out; 791616300bdSMauro Carvalho Chehab } 792616300bdSMauro Carvalho Chehab 793616300bdSMauro Carvalho Chehab stat->active_system = r->operand[10]; 794616300bdSMauro Carvalho Chehab stat->searching = r->operand[11] >> 7 & 1; 795616300bdSMauro Carvalho Chehab stat->moving = r->operand[11] >> 6 & 1; 796616300bdSMauro Carvalho Chehab stat->no_rf = r->operand[11] >> 5 & 1; 797616300bdSMauro Carvalho Chehab stat->input = r->operand[12] >> 7 & 1; 798616300bdSMauro Carvalho Chehab stat->selected_antenna = r->operand[12] & 0x7f; 799616300bdSMauro Carvalho Chehab stat->ber = r->operand[13] << 24 | 800616300bdSMauro Carvalho Chehab r->operand[14] << 16 | 801616300bdSMauro Carvalho Chehab r->operand[15] << 8 | 802616300bdSMauro Carvalho Chehab r->operand[16]; 803616300bdSMauro Carvalho Chehab stat->signal_strength = r->operand[17]; 804616300bdSMauro Carvalho Chehab stat->raster_frequency = r->operand[18] >> 6 & 2; 805616300bdSMauro Carvalho Chehab stat->rf_frequency = (r->operand[18] & 0x3f) << 16 | 806616300bdSMauro Carvalho Chehab r->operand[19] << 8 | 807616300bdSMauro Carvalho Chehab r->operand[20]; 808616300bdSMauro Carvalho Chehab stat->man_dep_info_length = r->operand[21]; 809616300bdSMauro Carvalho Chehab stat->front_end_error = r->operand[22] >> 4 & 1; 810616300bdSMauro Carvalho Chehab stat->antenna_error = r->operand[22] >> 3 & 1; 811616300bdSMauro Carvalho Chehab stat->front_end_power_status = r->operand[22] >> 1 & 1; 812616300bdSMauro Carvalho Chehab stat->power_supply = r->operand[22] & 1; 813616300bdSMauro Carvalho Chehab stat->carrier_noise_ratio = r->operand[23] << 8 | 814616300bdSMauro Carvalho Chehab r->operand[24]; 815616300bdSMauro Carvalho Chehab stat->power_supply_voltage = r->operand[27]; 816616300bdSMauro Carvalho Chehab stat->antenna_voltage = r->operand[28]; 817616300bdSMauro Carvalho Chehab stat->firewire_bus_voltage = r->operand[29]; 818616300bdSMauro Carvalho Chehab stat->ca_mmi = r->operand[30] & 1; 819616300bdSMauro Carvalho Chehab stat->ca_pmt_reply = r->operand[31] >> 7 & 1; 820616300bdSMauro Carvalho Chehab stat->ca_date_time_request = r->operand[31] >> 6 & 1; 821616300bdSMauro Carvalho Chehab stat->ca_application_info = r->operand[31] >> 5 & 1; 822616300bdSMauro Carvalho Chehab stat->ca_module_present_status = r->operand[31] >> 4 & 1; 823616300bdSMauro Carvalho Chehab stat->ca_dvb_flag = r->operand[31] >> 3 & 1; 824616300bdSMauro Carvalho Chehab stat->ca_error_flag = r->operand[31] >> 2 & 1; 825616300bdSMauro Carvalho Chehab stat->ca_initialization_status = r->operand[31] >> 1 & 1; 826616300bdSMauro Carvalho Chehab out: 827616300bdSMauro Carvalho Chehab mutex_unlock(&fdtv->avc_mutex); 828616300bdSMauro Carvalho Chehab 829616300bdSMauro Carvalho Chehab return ret; 830616300bdSMauro Carvalho Chehab } 831616300bdSMauro Carvalho Chehab 832616300bdSMauro Carvalho Chehab int avc_lnb_control(struct firedtv *fdtv, char voltage, char burst, 833616300bdSMauro Carvalho Chehab char conttone, char nrdiseq, 834616300bdSMauro Carvalho Chehab struct dvb_diseqc_master_cmd *diseqcmd) 835616300bdSMauro Carvalho Chehab { 836616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 837616300bdSMauro Carvalho Chehab struct avc_response_frame *r = (void *)fdtv->avc_data; 838616300bdSMauro Carvalho Chehab int pos, j, k, ret; 839616300bdSMauro Carvalho Chehab 840616300bdSMauro Carvalho Chehab mutex_lock(&fdtv->avc_mutex); 841616300bdSMauro Carvalho Chehab 842616300bdSMauro Carvalho Chehab c->ctype = AVC_CTYPE_CONTROL; 843616300bdSMauro Carvalho Chehab c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; 844616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_VENDOR; 845616300bdSMauro Carvalho Chehab 846616300bdSMauro Carvalho Chehab c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; 847616300bdSMauro Carvalho Chehab c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; 848616300bdSMauro Carvalho Chehab c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; 849616300bdSMauro Carvalho Chehab c->operand[3] = SFE_VENDOR_OPCODE_LNB_CONTROL; 850616300bdSMauro Carvalho Chehab c->operand[4] = voltage; 851616300bdSMauro Carvalho Chehab c->operand[5] = nrdiseq; 852616300bdSMauro Carvalho Chehab 853616300bdSMauro Carvalho Chehab pos = 6; 854616300bdSMauro Carvalho Chehab for (j = 0; j < nrdiseq; j++) { 855616300bdSMauro Carvalho Chehab c->operand[pos++] = diseqcmd[j].msg_len; 856616300bdSMauro Carvalho Chehab 857616300bdSMauro Carvalho Chehab for (k = 0; k < diseqcmd[j].msg_len; k++) 858616300bdSMauro Carvalho Chehab c->operand[pos++] = diseqcmd[j].msg[k]; 859616300bdSMauro Carvalho Chehab } 860616300bdSMauro Carvalho Chehab c->operand[pos++] = burst; 861616300bdSMauro Carvalho Chehab c->operand[pos++] = conttone; 862616300bdSMauro Carvalho Chehab pad_operands(c, pos); 863616300bdSMauro Carvalho Chehab 864616300bdSMauro Carvalho Chehab fdtv->avc_data_length = ALIGN(3 + pos, 4); 865616300bdSMauro Carvalho Chehab ret = avc_write(fdtv); 866616300bdSMauro Carvalho Chehab if (ret < 0) 867616300bdSMauro Carvalho Chehab goto out; 868616300bdSMauro Carvalho Chehab 869616300bdSMauro Carvalho Chehab if (r->response != AVC_RESPONSE_ACCEPTED) { 870616300bdSMauro Carvalho Chehab dev_err(fdtv->device, "LNB control failed\n"); 871616300bdSMauro Carvalho Chehab ret = -EINVAL; 872616300bdSMauro Carvalho Chehab } 873616300bdSMauro Carvalho Chehab out: 874616300bdSMauro Carvalho Chehab mutex_unlock(&fdtv->avc_mutex); 875616300bdSMauro Carvalho Chehab 876616300bdSMauro Carvalho Chehab return ret; 877616300bdSMauro Carvalho Chehab } 878616300bdSMauro Carvalho Chehab 879616300bdSMauro Carvalho Chehab int avc_register_remote_control(struct firedtv *fdtv) 880616300bdSMauro Carvalho Chehab { 881616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 882616300bdSMauro Carvalho Chehab int ret; 883616300bdSMauro Carvalho Chehab 884616300bdSMauro Carvalho Chehab mutex_lock(&fdtv->avc_mutex); 885616300bdSMauro Carvalho Chehab 886616300bdSMauro Carvalho Chehab c->ctype = AVC_CTYPE_NOTIFY; 887616300bdSMauro Carvalho Chehab c->subunit = AVC_SUBUNIT_TYPE_UNIT | 7; 888616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_VENDOR; 889616300bdSMauro Carvalho Chehab 890616300bdSMauro Carvalho Chehab c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; 891616300bdSMauro Carvalho Chehab c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; 892616300bdSMauro Carvalho Chehab c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; 893616300bdSMauro Carvalho Chehab c->operand[3] = SFE_VENDOR_OPCODE_REGISTER_REMOTE_CONTROL; 894616300bdSMauro Carvalho Chehab c->operand[4] = 0; /* padding */ 895616300bdSMauro Carvalho Chehab 896616300bdSMauro Carvalho Chehab fdtv->avc_data_length = 8; 897616300bdSMauro Carvalho Chehab ret = avc_write(fdtv); 898616300bdSMauro Carvalho Chehab 899616300bdSMauro Carvalho Chehab /* FIXME: check response code? */ 900616300bdSMauro Carvalho Chehab 901616300bdSMauro Carvalho Chehab mutex_unlock(&fdtv->avc_mutex); 902616300bdSMauro Carvalho Chehab 903616300bdSMauro Carvalho Chehab return ret; 904616300bdSMauro Carvalho Chehab } 905616300bdSMauro Carvalho Chehab 906616300bdSMauro Carvalho Chehab void avc_remote_ctrl_work(struct work_struct *work) 907616300bdSMauro Carvalho Chehab { 908616300bdSMauro Carvalho Chehab struct firedtv *fdtv = 909616300bdSMauro Carvalho Chehab container_of(work, struct firedtv, remote_ctrl_work); 910616300bdSMauro Carvalho Chehab 911616300bdSMauro Carvalho Chehab /* Should it be rescheduled in failure cases? */ 912616300bdSMauro Carvalho Chehab avc_register_remote_control(fdtv); 913616300bdSMauro Carvalho Chehab } 914616300bdSMauro Carvalho Chehab 915616300bdSMauro Carvalho Chehab #if 0 /* FIXME: unused */ 916616300bdSMauro Carvalho Chehab int avc_tuner_host2ca(struct firedtv *fdtv) 917616300bdSMauro Carvalho Chehab { 918616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 919616300bdSMauro Carvalho Chehab int ret; 920616300bdSMauro Carvalho Chehab 921616300bdSMauro Carvalho Chehab mutex_lock(&fdtv->avc_mutex); 922616300bdSMauro Carvalho Chehab 923616300bdSMauro Carvalho Chehab c->ctype = AVC_CTYPE_CONTROL; 924616300bdSMauro Carvalho Chehab c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; 925616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_VENDOR; 926616300bdSMauro Carvalho Chehab 927616300bdSMauro Carvalho Chehab c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; 928616300bdSMauro Carvalho Chehab c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; 929616300bdSMauro Carvalho Chehab c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; 930616300bdSMauro Carvalho Chehab c->operand[3] = SFE_VENDOR_OPCODE_HOST2CA; 931616300bdSMauro Carvalho Chehab c->operand[4] = 0; /* slot */ 932616300bdSMauro Carvalho Chehab c->operand[5] = SFE_VENDOR_TAG_CA_APPLICATION_INFO; /* ca tag */ 933616300bdSMauro Carvalho Chehab clear_operands(c, 6, 8); 934616300bdSMauro Carvalho Chehab 935616300bdSMauro Carvalho Chehab fdtv->avc_data_length = 12; 936616300bdSMauro Carvalho Chehab ret = avc_write(fdtv); 937616300bdSMauro Carvalho Chehab 938616300bdSMauro Carvalho Chehab /* FIXME: check response code? */ 939616300bdSMauro Carvalho Chehab 940616300bdSMauro Carvalho Chehab mutex_unlock(&fdtv->avc_mutex); 941616300bdSMauro Carvalho Chehab 942616300bdSMauro Carvalho Chehab return ret; 943616300bdSMauro Carvalho Chehab } 944616300bdSMauro Carvalho Chehab #endif 945616300bdSMauro Carvalho Chehab 946616300bdSMauro Carvalho Chehab static int get_ca_object_pos(struct avc_response_frame *r) 947616300bdSMauro Carvalho Chehab { 948616300bdSMauro Carvalho Chehab int length = 1; 949616300bdSMauro Carvalho Chehab 950616300bdSMauro Carvalho Chehab /* Check length of length field */ 951616300bdSMauro Carvalho Chehab if (r->operand[7] & 0x80) 952616300bdSMauro Carvalho Chehab length = (r->operand[7] & 0x7f) + 1; 953616300bdSMauro Carvalho Chehab return length + 7; 954616300bdSMauro Carvalho Chehab } 955616300bdSMauro Carvalho Chehab 956616300bdSMauro Carvalho Chehab static int get_ca_object_length(struct avc_response_frame *r) 957616300bdSMauro Carvalho Chehab { 958616300bdSMauro Carvalho Chehab #if 0 /* FIXME: unused */ 959616300bdSMauro Carvalho Chehab int size = 0; 960616300bdSMauro Carvalho Chehab int i; 961616300bdSMauro Carvalho Chehab 962616300bdSMauro Carvalho Chehab if (r->operand[7] & 0x80) 963616300bdSMauro Carvalho Chehab for (i = 0; i < (r->operand[7] & 0x7f); i++) { 964616300bdSMauro Carvalho Chehab size <<= 8; 965616300bdSMauro Carvalho Chehab size += r->operand[8 + i]; 966616300bdSMauro Carvalho Chehab } 967616300bdSMauro Carvalho Chehab #endif 968616300bdSMauro Carvalho Chehab return r->operand[7]; 969616300bdSMauro Carvalho Chehab } 970616300bdSMauro Carvalho Chehab 971616300bdSMauro Carvalho Chehab int avc_ca_app_info(struct firedtv *fdtv, char *app_info, unsigned int *len) 972616300bdSMauro Carvalho Chehab { 973616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 974616300bdSMauro Carvalho Chehab struct avc_response_frame *r = (void *)fdtv->avc_data; 975616300bdSMauro Carvalho Chehab int pos, ret; 976616300bdSMauro Carvalho Chehab 977616300bdSMauro Carvalho Chehab mutex_lock(&fdtv->avc_mutex); 978616300bdSMauro Carvalho Chehab 979616300bdSMauro Carvalho Chehab c->ctype = AVC_CTYPE_STATUS; 980616300bdSMauro Carvalho Chehab c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; 981616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_VENDOR; 982616300bdSMauro Carvalho Chehab 983616300bdSMauro Carvalho Chehab c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; 984616300bdSMauro Carvalho Chehab c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; 985616300bdSMauro Carvalho Chehab c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; 986616300bdSMauro Carvalho Chehab c->operand[3] = SFE_VENDOR_OPCODE_CA2HOST; 987616300bdSMauro Carvalho Chehab c->operand[4] = 0; /* slot */ 988616300bdSMauro Carvalho Chehab c->operand[5] = SFE_VENDOR_TAG_CA_APPLICATION_INFO; /* ca tag */ 989616300bdSMauro Carvalho Chehab clear_operands(c, 6, LAST_OPERAND); 990616300bdSMauro Carvalho Chehab 991616300bdSMauro Carvalho Chehab fdtv->avc_data_length = 12; 992616300bdSMauro Carvalho Chehab ret = avc_write(fdtv); 993616300bdSMauro Carvalho Chehab if (ret < 0) 994616300bdSMauro Carvalho Chehab goto out; 995616300bdSMauro Carvalho Chehab 996616300bdSMauro Carvalho Chehab /* FIXME: check response code and validate response data */ 997616300bdSMauro Carvalho Chehab 998616300bdSMauro Carvalho Chehab pos = get_ca_object_pos(r); 999616300bdSMauro Carvalho Chehab app_info[0] = (EN50221_TAG_APP_INFO >> 16) & 0xff; 1000616300bdSMauro Carvalho Chehab app_info[1] = (EN50221_TAG_APP_INFO >> 8) & 0xff; 1001616300bdSMauro Carvalho Chehab app_info[2] = (EN50221_TAG_APP_INFO >> 0) & 0xff; 1002616300bdSMauro Carvalho Chehab app_info[3] = 6 + r->operand[pos + 4]; 1003616300bdSMauro Carvalho Chehab app_info[4] = 0x01; 1004616300bdSMauro Carvalho Chehab memcpy(&app_info[5], &r->operand[pos], 5 + r->operand[pos + 4]); 1005616300bdSMauro Carvalho Chehab *len = app_info[3] + 4; 1006616300bdSMauro Carvalho Chehab out: 1007616300bdSMauro Carvalho Chehab mutex_unlock(&fdtv->avc_mutex); 1008616300bdSMauro Carvalho Chehab 1009616300bdSMauro Carvalho Chehab return ret; 1010616300bdSMauro Carvalho Chehab } 1011616300bdSMauro Carvalho Chehab 1012616300bdSMauro Carvalho Chehab int avc_ca_info(struct firedtv *fdtv, char *app_info, unsigned int *len) 1013616300bdSMauro Carvalho Chehab { 1014616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 1015616300bdSMauro Carvalho Chehab struct avc_response_frame *r = (void *)fdtv->avc_data; 1016616300bdSMauro Carvalho Chehab int i, pos, ret; 1017616300bdSMauro Carvalho Chehab 1018616300bdSMauro Carvalho Chehab mutex_lock(&fdtv->avc_mutex); 1019616300bdSMauro Carvalho Chehab 1020616300bdSMauro Carvalho Chehab c->ctype = AVC_CTYPE_STATUS; 1021616300bdSMauro Carvalho Chehab c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; 1022616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_VENDOR; 1023616300bdSMauro Carvalho Chehab 1024616300bdSMauro Carvalho Chehab c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; 1025616300bdSMauro Carvalho Chehab c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; 1026616300bdSMauro Carvalho Chehab c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; 1027616300bdSMauro Carvalho Chehab c->operand[3] = SFE_VENDOR_OPCODE_CA2HOST; 1028616300bdSMauro Carvalho Chehab c->operand[4] = 0; /* slot */ 1029616300bdSMauro Carvalho Chehab c->operand[5] = SFE_VENDOR_TAG_CA_APPLICATION_INFO; /* ca tag */ 1030616300bdSMauro Carvalho Chehab clear_operands(c, 6, LAST_OPERAND); 1031616300bdSMauro Carvalho Chehab 1032616300bdSMauro Carvalho Chehab fdtv->avc_data_length = 12; 1033616300bdSMauro Carvalho Chehab ret = avc_write(fdtv); 1034616300bdSMauro Carvalho Chehab if (ret < 0) 1035616300bdSMauro Carvalho Chehab goto out; 1036616300bdSMauro Carvalho Chehab 1037616300bdSMauro Carvalho Chehab /* FIXME: check response code and validate response data */ 1038616300bdSMauro Carvalho Chehab 1039616300bdSMauro Carvalho Chehab pos = get_ca_object_pos(r); 1040616300bdSMauro Carvalho Chehab app_info[0] = (EN50221_TAG_CA_INFO >> 16) & 0xff; 1041616300bdSMauro Carvalho Chehab app_info[1] = (EN50221_TAG_CA_INFO >> 8) & 0xff; 1042616300bdSMauro Carvalho Chehab app_info[2] = (EN50221_TAG_CA_INFO >> 0) & 0xff; 1043616300bdSMauro Carvalho Chehab if (num_fake_ca_system_ids == 0) { 1044616300bdSMauro Carvalho Chehab app_info[3] = 2; 1045616300bdSMauro Carvalho Chehab app_info[4] = r->operand[pos + 0]; 1046616300bdSMauro Carvalho Chehab app_info[5] = r->operand[pos + 1]; 1047616300bdSMauro Carvalho Chehab } else { 1048616300bdSMauro Carvalho Chehab app_info[3] = num_fake_ca_system_ids * 2; 1049616300bdSMauro Carvalho Chehab for (i = 0; i < num_fake_ca_system_ids; i++) { 1050616300bdSMauro Carvalho Chehab app_info[4 + i * 2] = 1051616300bdSMauro Carvalho Chehab (fake_ca_system_ids[i] >> 8) & 0xff; 1052616300bdSMauro Carvalho Chehab app_info[5 + i * 2] = fake_ca_system_ids[i] & 0xff; 1053616300bdSMauro Carvalho Chehab } 1054616300bdSMauro Carvalho Chehab } 1055616300bdSMauro Carvalho Chehab *len = app_info[3] + 4; 1056616300bdSMauro Carvalho Chehab out: 1057616300bdSMauro Carvalho Chehab mutex_unlock(&fdtv->avc_mutex); 1058616300bdSMauro Carvalho Chehab 1059616300bdSMauro Carvalho Chehab return ret; 1060616300bdSMauro Carvalho Chehab } 1061616300bdSMauro Carvalho Chehab 1062616300bdSMauro Carvalho Chehab int avc_ca_reset(struct firedtv *fdtv) 1063616300bdSMauro Carvalho Chehab { 1064616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 1065616300bdSMauro Carvalho Chehab int ret; 1066616300bdSMauro Carvalho Chehab 1067616300bdSMauro Carvalho Chehab mutex_lock(&fdtv->avc_mutex); 1068616300bdSMauro Carvalho Chehab 1069616300bdSMauro Carvalho Chehab c->ctype = AVC_CTYPE_CONTROL; 1070616300bdSMauro Carvalho Chehab c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; 1071616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_VENDOR; 1072616300bdSMauro Carvalho Chehab 1073616300bdSMauro Carvalho Chehab c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; 1074616300bdSMauro Carvalho Chehab c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; 1075616300bdSMauro Carvalho Chehab c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; 1076616300bdSMauro Carvalho Chehab c->operand[3] = SFE_VENDOR_OPCODE_HOST2CA; 1077616300bdSMauro Carvalho Chehab c->operand[4] = 0; /* slot */ 1078616300bdSMauro Carvalho Chehab c->operand[5] = SFE_VENDOR_TAG_CA_RESET; /* ca tag */ 1079616300bdSMauro Carvalho Chehab c->operand[6] = 0; /* more/last */ 1080616300bdSMauro Carvalho Chehab c->operand[7] = 1; /* length */ 1081616300bdSMauro Carvalho Chehab c->operand[8] = 0; /* force hardware reset */ 1082616300bdSMauro Carvalho Chehab 1083616300bdSMauro Carvalho Chehab fdtv->avc_data_length = 12; 1084616300bdSMauro Carvalho Chehab ret = avc_write(fdtv); 1085616300bdSMauro Carvalho Chehab 1086616300bdSMauro Carvalho Chehab /* FIXME: check response code? */ 1087616300bdSMauro Carvalho Chehab 1088616300bdSMauro Carvalho Chehab mutex_unlock(&fdtv->avc_mutex); 1089616300bdSMauro Carvalho Chehab 1090616300bdSMauro Carvalho Chehab return ret; 1091616300bdSMauro Carvalho Chehab } 1092616300bdSMauro Carvalho Chehab 1093616300bdSMauro Carvalho Chehab int avc_ca_pmt(struct firedtv *fdtv, char *msg, int length) 1094616300bdSMauro Carvalho Chehab { 1095616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 1096616300bdSMauro Carvalho Chehab struct avc_response_frame *r = (void *)fdtv->avc_data; 1097616300bdSMauro Carvalho Chehab int list_management; 1098616300bdSMauro Carvalho Chehab int program_info_length; 1099616300bdSMauro Carvalho Chehab int pmt_cmd_id; 1100616300bdSMauro Carvalho Chehab int read_pos; 1101616300bdSMauro Carvalho Chehab int write_pos; 1102616300bdSMauro Carvalho Chehab int es_info_length; 1103616300bdSMauro Carvalho Chehab int crc32_csum; 1104616300bdSMauro Carvalho Chehab int ret; 1105616300bdSMauro Carvalho Chehab 1106616300bdSMauro Carvalho Chehab if (unlikely(avc_debug & AVC_DEBUG_APPLICATION_PMT)) 1107616300bdSMauro Carvalho Chehab debug_pmt(msg, length); 1108616300bdSMauro Carvalho Chehab 1109616300bdSMauro Carvalho Chehab mutex_lock(&fdtv->avc_mutex); 1110616300bdSMauro Carvalho Chehab 1111616300bdSMauro Carvalho Chehab c->ctype = AVC_CTYPE_CONTROL; 1112616300bdSMauro Carvalho Chehab c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; 1113616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_VENDOR; 1114616300bdSMauro Carvalho Chehab 1115616300bdSMauro Carvalho Chehab if (msg[0] != EN50221_LIST_MANAGEMENT_ONLY) { 1116616300bdSMauro Carvalho Chehab dev_info(fdtv->device, "forcing list_management to ONLY\n"); 1117616300bdSMauro Carvalho Chehab msg[0] = EN50221_LIST_MANAGEMENT_ONLY; 1118616300bdSMauro Carvalho Chehab } 1119616300bdSMauro Carvalho Chehab /* We take the cmd_id from the programme level only! */ 1120616300bdSMauro Carvalho Chehab list_management = msg[0]; 1121616300bdSMauro Carvalho Chehab program_info_length = ((msg[4] & 0x0f) << 8) + msg[5]; 1122616300bdSMauro Carvalho Chehab if (program_info_length > 0) 1123616300bdSMauro Carvalho Chehab program_info_length--; /* Remove pmt_cmd_id */ 1124616300bdSMauro Carvalho Chehab pmt_cmd_id = msg[6]; 1125616300bdSMauro Carvalho Chehab 1126616300bdSMauro Carvalho Chehab c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; 1127616300bdSMauro Carvalho Chehab c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; 1128616300bdSMauro Carvalho Chehab c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; 1129616300bdSMauro Carvalho Chehab c->operand[3] = SFE_VENDOR_OPCODE_HOST2CA; 1130616300bdSMauro Carvalho Chehab c->operand[4] = 0; /* slot */ 1131616300bdSMauro Carvalho Chehab c->operand[5] = SFE_VENDOR_TAG_CA_PMT; /* ca tag */ 1132616300bdSMauro Carvalho Chehab c->operand[6] = 0; /* more/last */ 1133616300bdSMauro Carvalho Chehab /* Use three bytes for length field in case length > 127 */ 1134616300bdSMauro Carvalho Chehab c->operand[10] = list_management; 1135616300bdSMauro Carvalho Chehab c->operand[11] = 0x01; /* pmt_cmd=OK_descramble */ 1136616300bdSMauro Carvalho Chehab 1137616300bdSMauro Carvalho Chehab /* TS program map table */ 1138616300bdSMauro Carvalho Chehab 1139616300bdSMauro Carvalho Chehab c->operand[12] = 0x02; /* Table id=2 */ 1140616300bdSMauro Carvalho Chehab c->operand[13] = 0x80; /* Section syntax + length */ 1141616300bdSMauro Carvalho Chehab 1142616300bdSMauro Carvalho Chehab c->operand[15] = msg[1]; /* Program number */ 1143616300bdSMauro Carvalho Chehab c->operand[16] = msg[2]; 1144616300bdSMauro Carvalho Chehab c->operand[17] = msg[3]; /* Version number and current/next */ 1145616300bdSMauro Carvalho Chehab c->operand[18] = 0x00; /* Section number=0 */ 1146616300bdSMauro Carvalho Chehab c->operand[19] = 0x00; /* Last section number=0 */ 1147616300bdSMauro Carvalho Chehab c->operand[20] = 0x1f; /* PCR_PID=1FFF */ 1148616300bdSMauro Carvalho Chehab c->operand[21] = 0xff; 1149616300bdSMauro Carvalho Chehab c->operand[22] = (program_info_length >> 8); /* Program info length */ 1150616300bdSMauro Carvalho Chehab c->operand[23] = (program_info_length & 0xff); 1151616300bdSMauro Carvalho Chehab 1152616300bdSMauro Carvalho Chehab /* CA descriptors at programme level */ 1153616300bdSMauro Carvalho Chehab read_pos = 6; 1154616300bdSMauro Carvalho Chehab write_pos = 24; 1155616300bdSMauro Carvalho Chehab if (program_info_length > 0) { 1156616300bdSMauro Carvalho Chehab pmt_cmd_id = msg[read_pos++]; 1157616300bdSMauro Carvalho Chehab if (pmt_cmd_id != 1 && pmt_cmd_id != 4) 1158616300bdSMauro Carvalho Chehab dev_err(fdtv->device, 1159616300bdSMauro Carvalho Chehab "invalid pmt_cmd_id %d\n", pmt_cmd_id); 1160616300bdSMauro Carvalho Chehab 1161616300bdSMauro Carvalho Chehab memcpy(&c->operand[write_pos], &msg[read_pos], 1162616300bdSMauro Carvalho Chehab program_info_length); 1163616300bdSMauro Carvalho Chehab read_pos += program_info_length; 1164616300bdSMauro Carvalho Chehab write_pos += program_info_length; 1165616300bdSMauro Carvalho Chehab } 1166616300bdSMauro Carvalho Chehab while (read_pos < length) { 1167616300bdSMauro Carvalho Chehab c->operand[write_pos++] = msg[read_pos++]; 1168616300bdSMauro Carvalho Chehab c->operand[write_pos++] = msg[read_pos++]; 1169616300bdSMauro Carvalho Chehab c->operand[write_pos++] = msg[read_pos++]; 1170616300bdSMauro Carvalho Chehab es_info_length = 1171616300bdSMauro Carvalho Chehab ((msg[read_pos] & 0x0f) << 8) + msg[read_pos + 1]; 1172616300bdSMauro Carvalho Chehab read_pos += 2; 1173616300bdSMauro Carvalho Chehab if (es_info_length > 0) 1174616300bdSMauro Carvalho Chehab es_info_length--; /* Remove pmt_cmd_id */ 1175616300bdSMauro Carvalho Chehab c->operand[write_pos++] = es_info_length >> 8; 1176616300bdSMauro Carvalho Chehab c->operand[write_pos++] = es_info_length & 0xff; 1177616300bdSMauro Carvalho Chehab if (es_info_length > 0) { 1178616300bdSMauro Carvalho Chehab pmt_cmd_id = msg[read_pos++]; 1179616300bdSMauro Carvalho Chehab if (pmt_cmd_id != 1 && pmt_cmd_id != 4) 1180616300bdSMauro Carvalho Chehab dev_err(fdtv->device, "invalid pmt_cmd_id %d " 1181616300bdSMauro Carvalho Chehab "at stream level\n", pmt_cmd_id); 1182616300bdSMauro Carvalho Chehab 1183616300bdSMauro Carvalho Chehab memcpy(&c->operand[write_pos], &msg[read_pos], 1184616300bdSMauro Carvalho Chehab es_info_length); 1185616300bdSMauro Carvalho Chehab read_pos += es_info_length; 1186616300bdSMauro Carvalho Chehab write_pos += es_info_length; 1187616300bdSMauro Carvalho Chehab } 1188616300bdSMauro Carvalho Chehab } 1189616300bdSMauro Carvalho Chehab write_pos += 4; /* CRC */ 1190616300bdSMauro Carvalho Chehab 1191616300bdSMauro Carvalho Chehab c->operand[7] = 0x82; 1192616300bdSMauro Carvalho Chehab c->operand[8] = (write_pos - 10) >> 8; 1193616300bdSMauro Carvalho Chehab c->operand[9] = (write_pos - 10) & 0xff; 1194616300bdSMauro Carvalho Chehab c->operand[14] = write_pos - 15; 1195616300bdSMauro Carvalho Chehab 1196616300bdSMauro Carvalho Chehab crc32_csum = crc32_be(0, &c->operand[10], c->operand[12] - 1); 1197616300bdSMauro Carvalho Chehab c->operand[write_pos - 4] = (crc32_csum >> 24) & 0xff; 1198616300bdSMauro Carvalho Chehab c->operand[write_pos - 3] = (crc32_csum >> 16) & 0xff; 1199616300bdSMauro Carvalho Chehab c->operand[write_pos - 2] = (crc32_csum >> 8) & 0xff; 1200616300bdSMauro Carvalho Chehab c->operand[write_pos - 1] = (crc32_csum >> 0) & 0xff; 1201616300bdSMauro Carvalho Chehab pad_operands(c, write_pos); 1202616300bdSMauro Carvalho Chehab 1203616300bdSMauro Carvalho Chehab fdtv->avc_data_length = ALIGN(3 + write_pos, 4); 1204616300bdSMauro Carvalho Chehab ret = avc_write(fdtv); 1205616300bdSMauro Carvalho Chehab if (ret < 0) 1206616300bdSMauro Carvalho Chehab goto out; 1207616300bdSMauro Carvalho Chehab 1208616300bdSMauro Carvalho Chehab if (r->response != AVC_RESPONSE_ACCEPTED) { 1209616300bdSMauro Carvalho Chehab dev_err(fdtv->device, 1210616300bdSMauro Carvalho Chehab "CA PMT failed with response 0x%x\n", r->response); 1211616300bdSMauro Carvalho Chehab ret = -EACCES; 1212616300bdSMauro Carvalho Chehab } 1213616300bdSMauro Carvalho Chehab out: 1214616300bdSMauro Carvalho Chehab mutex_unlock(&fdtv->avc_mutex); 1215616300bdSMauro Carvalho Chehab 1216616300bdSMauro Carvalho Chehab return ret; 1217616300bdSMauro Carvalho Chehab } 1218616300bdSMauro Carvalho Chehab 1219616300bdSMauro Carvalho Chehab int avc_ca_get_time_date(struct firedtv *fdtv, int *interval) 1220616300bdSMauro Carvalho Chehab { 1221616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 1222616300bdSMauro Carvalho Chehab struct avc_response_frame *r = (void *)fdtv->avc_data; 1223616300bdSMauro Carvalho Chehab int ret; 1224616300bdSMauro Carvalho Chehab 1225616300bdSMauro Carvalho Chehab mutex_lock(&fdtv->avc_mutex); 1226616300bdSMauro Carvalho Chehab 1227616300bdSMauro Carvalho Chehab c->ctype = AVC_CTYPE_STATUS; 1228616300bdSMauro Carvalho Chehab c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; 1229616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_VENDOR; 1230616300bdSMauro Carvalho Chehab 1231616300bdSMauro Carvalho Chehab c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; 1232616300bdSMauro Carvalho Chehab c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; 1233616300bdSMauro Carvalho Chehab c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; 1234616300bdSMauro Carvalho Chehab c->operand[3] = SFE_VENDOR_OPCODE_CA2HOST; 1235616300bdSMauro Carvalho Chehab c->operand[4] = 0; /* slot */ 1236616300bdSMauro Carvalho Chehab c->operand[5] = SFE_VENDOR_TAG_CA_DATE_TIME; /* ca tag */ 1237616300bdSMauro Carvalho Chehab clear_operands(c, 6, LAST_OPERAND); 1238616300bdSMauro Carvalho Chehab 1239616300bdSMauro Carvalho Chehab fdtv->avc_data_length = 12; 1240616300bdSMauro Carvalho Chehab ret = avc_write(fdtv); 1241616300bdSMauro Carvalho Chehab if (ret < 0) 1242616300bdSMauro Carvalho Chehab goto out; 1243616300bdSMauro Carvalho Chehab 1244616300bdSMauro Carvalho Chehab /* FIXME: check response code and validate response data */ 1245616300bdSMauro Carvalho Chehab 1246616300bdSMauro Carvalho Chehab *interval = r->operand[get_ca_object_pos(r)]; 1247616300bdSMauro Carvalho Chehab out: 1248616300bdSMauro Carvalho Chehab mutex_unlock(&fdtv->avc_mutex); 1249616300bdSMauro Carvalho Chehab 1250616300bdSMauro Carvalho Chehab return ret; 1251616300bdSMauro Carvalho Chehab } 1252616300bdSMauro Carvalho Chehab 1253616300bdSMauro Carvalho Chehab int avc_ca_enter_menu(struct firedtv *fdtv) 1254616300bdSMauro Carvalho Chehab { 1255616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 1256616300bdSMauro Carvalho Chehab int ret; 1257616300bdSMauro Carvalho Chehab 1258616300bdSMauro Carvalho Chehab mutex_lock(&fdtv->avc_mutex); 1259616300bdSMauro Carvalho Chehab 1260616300bdSMauro Carvalho Chehab c->ctype = AVC_CTYPE_STATUS; 1261616300bdSMauro Carvalho Chehab c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; 1262616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_VENDOR; 1263616300bdSMauro Carvalho Chehab 1264616300bdSMauro Carvalho Chehab c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; 1265616300bdSMauro Carvalho Chehab c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; 1266616300bdSMauro Carvalho Chehab c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; 1267616300bdSMauro Carvalho Chehab c->operand[3] = SFE_VENDOR_OPCODE_HOST2CA; 1268616300bdSMauro Carvalho Chehab c->operand[4] = 0; /* slot */ 1269616300bdSMauro Carvalho Chehab c->operand[5] = SFE_VENDOR_TAG_CA_ENTER_MENU; 1270616300bdSMauro Carvalho Chehab clear_operands(c, 6, 8); 1271616300bdSMauro Carvalho Chehab 1272616300bdSMauro Carvalho Chehab fdtv->avc_data_length = 12; 1273616300bdSMauro Carvalho Chehab ret = avc_write(fdtv); 1274616300bdSMauro Carvalho Chehab 1275616300bdSMauro Carvalho Chehab /* FIXME: check response code? */ 1276616300bdSMauro Carvalho Chehab 1277616300bdSMauro Carvalho Chehab mutex_unlock(&fdtv->avc_mutex); 1278616300bdSMauro Carvalho Chehab 1279616300bdSMauro Carvalho Chehab return ret; 1280616300bdSMauro Carvalho Chehab } 1281616300bdSMauro Carvalho Chehab 1282616300bdSMauro Carvalho Chehab int avc_ca_get_mmi(struct firedtv *fdtv, char *mmi_object, unsigned int *len) 1283616300bdSMauro Carvalho Chehab { 1284616300bdSMauro Carvalho Chehab struct avc_command_frame *c = (void *)fdtv->avc_data; 1285616300bdSMauro Carvalho Chehab struct avc_response_frame *r = (void *)fdtv->avc_data; 1286616300bdSMauro Carvalho Chehab int ret; 1287616300bdSMauro Carvalho Chehab 1288616300bdSMauro Carvalho Chehab mutex_lock(&fdtv->avc_mutex); 1289616300bdSMauro Carvalho Chehab 1290616300bdSMauro Carvalho Chehab c->ctype = AVC_CTYPE_STATUS; 1291616300bdSMauro Carvalho Chehab c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; 1292616300bdSMauro Carvalho Chehab c->opcode = AVC_OPCODE_VENDOR; 1293616300bdSMauro Carvalho Chehab 1294616300bdSMauro Carvalho Chehab c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; 1295616300bdSMauro Carvalho Chehab c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; 1296616300bdSMauro Carvalho Chehab c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; 1297616300bdSMauro Carvalho Chehab c->operand[3] = SFE_VENDOR_OPCODE_CA2HOST; 1298616300bdSMauro Carvalho Chehab c->operand[4] = 0; /* slot */ 1299616300bdSMauro Carvalho Chehab c->operand[5] = SFE_VENDOR_TAG_CA_MMI; 1300616300bdSMauro Carvalho Chehab clear_operands(c, 6, LAST_OPERAND); 1301616300bdSMauro Carvalho Chehab 1302616300bdSMauro Carvalho Chehab fdtv->avc_data_length = 12; 1303616300bdSMauro Carvalho Chehab ret = avc_write(fdtv); 1304616300bdSMauro Carvalho Chehab if (ret < 0) 1305616300bdSMauro Carvalho Chehab goto out; 1306616300bdSMauro Carvalho Chehab 1307616300bdSMauro Carvalho Chehab /* FIXME: check response code and validate response data */ 1308616300bdSMauro Carvalho Chehab 1309616300bdSMauro Carvalho Chehab *len = get_ca_object_length(r); 1310616300bdSMauro Carvalho Chehab memcpy(mmi_object, &r->operand[get_ca_object_pos(r)], *len); 1311616300bdSMauro Carvalho Chehab out: 1312616300bdSMauro Carvalho Chehab mutex_unlock(&fdtv->avc_mutex); 1313616300bdSMauro Carvalho Chehab 1314616300bdSMauro Carvalho Chehab return ret; 1315616300bdSMauro Carvalho Chehab } 1316616300bdSMauro Carvalho Chehab 1317616300bdSMauro Carvalho Chehab #define CMP_OUTPUT_PLUG_CONTROL_REG_0 0xfffff0000904ULL 1318616300bdSMauro Carvalho Chehab 1319616300bdSMauro Carvalho Chehab static int cmp_read(struct firedtv *fdtv, u64 addr, __be32 *data) 1320616300bdSMauro Carvalho Chehab { 1321616300bdSMauro Carvalho Chehab int ret; 1322616300bdSMauro Carvalho Chehab 1323616300bdSMauro Carvalho Chehab ret = fdtv_read(fdtv, addr, data); 1324616300bdSMauro Carvalho Chehab if (ret < 0) 1325616300bdSMauro Carvalho Chehab dev_err(fdtv->device, "CMP: read I/O error\n"); 1326616300bdSMauro Carvalho Chehab 1327616300bdSMauro Carvalho Chehab return ret; 1328616300bdSMauro Carvalho Chehab } 1329616300bdSMauro Carvalho Chehab 1330616300bdSMauro Carvalho Chehab static int cmp_lock(struct firedtv *fdtv, u64 addr, __be32 data[]) 1331616300bdSMauro Carvalho Chehab { 1332616300bdSMauro Carvalho Chehab int ret; 1333616300bdSMauro Carvalho Chehab 1334616300bdSMauro Carvalho Chehab ret = fdtv_lock(fdtv, addr, data); 1335616300bdSMauro Carvalho Chehab if (ret < 0) 1336616300bdSMauro Carvalho Chehab dev_err(fdtv->device, "CMP: lock I/O error\n"); 1337616300bdSMauro Carvalho Chehab 1338616300bdSMauro Carvalho Chehab return ret; 1339616300bdSMauro Carvalho Chehab } 1340616300bdSMauro Carvalho Chehab 1341616300bdSMauro Carvalho Chehab static inline u32 get_opcr(__be32 opcr, u32 mask, u32 shift) 1342616300bdSMauro Carvalho Chehab { 1343616300bdSMauro Carvalho Chehab return (be32_to_cpu(opcr) >> shift) & mask; 1344616300bdSMauro Carvalho Chehab } 1345616300bdSMauro Carvalho Chehab 1346616300bdSMauro Carvalho Chehab static inline void set_opcr(__be32 *opcr, u32 value, u32 mask, u32 shift) 1347616300bdSMauro Carvalho Chehab { 1348616300bdSMauro Carvalho Chehab *opcr &= ~cpu_to_be32(mask << shift); 1349616300bdSMauro Carvalho Chehab *opcr |= cpu_to_be32((value & mask) << shift); 1350616300bdSMauro Carvalho Chehab } 1351616300bdSMauro Carvalho Chehab 1352616300bdSMauro Carvalho Chehab #define get_opcr_online(v) get_opcr((v), 0x1, 31) 1353616300bdSMauro Carvalho Chehab #define get_opcr_p2p_connections(v) get_opcr((v), 0x3f, 24) 1354616300bdSMauro Carvalho Chehab #define get_opcr_channel(v) get_opcr((v), 0x3f, 16) 1355616300bdSMauro Carvalho Chehab 1356616300bdSMauro Carvalho Chehab #define set_opcr_p2p_connections(p, v) set_opcr((p), (v), 0x3f, 24) 1357616300bdSMauro Carvalho Chehab #define set_opcr_channel(p, v) set_opcr((p), (v), 0x3f, 16) 1358616300bdSMauro Carvalho Chehab #define set_opcr_data_rate(p, v) set_opcr((p), (v), 0x3, 14) 1359616300bdSMauro Carvalho Chehab #define set_opcr_overhead_id(p, v) set_opcr((p), (v), 0xf, 10) 1360616300bdSMauro Carvalho Chehab 1361616300bdSMauro Carvalho Chehab int cmp_establish_pp_connection(struct firedtv *fdtv, int plug, int channel) 1362616300bdSMauro Carvalho Chehab { 1363616300bdSMauro Carvalho Chehab __be32 old_opcr, opcr[2]; 1364616300bdSMauro Carvalho Chehab u64 opcr_address = CMP_OUTPUT_PLUG_CONTROL_REG_0 + (plug << 2); 1365616300bdSMauro Carvalho Chehab int attempts = 0; 1366616300bdSMauro Carvalho Chehab int ret; 1367616300bdSMauro Carvalho Chehab 1368616300bdSMauro Carvalho Chehab ret = cmp_read(fdtv, opcr_address, opcr); 1369616300bdSMauro Carvalho Chehab if (ret < 0) 1370616300bdSMauro Carvalho Chehab return ret; 1371616300bdSMauro Carvalho Chehab 1372616300bdSMauro Carvalho Chehab repeat: 1373616300bdSMauro Carvalho Chehab if (!get_opcr_online(*opcr)) { 1374616300bdSMauro Carvalho Chehab dev_err(fdtv->device, "CMP: output offline\n"); 1375616300bdSMauro Carvalho Chehab return -EBUSY; 1376616300bdSMauro Carvalho Chehab } 1377616300bdSMauro Carvalho Chehab 1378616300bdSMauro Carvalho Chehab old_opcr = *opcr; 1379616300bdSMauro Carvalho Chehab 1380616300bdSMauro Carvalho Chehab if (get_opcr_p2p_connections(*opcr)) { 1381616300bdSMauro Carvalho Chehab if (get_opcr_channel(*opcr) != channel) { 1382616300bdSMauro Carvalho Chehab dev_err(fdtv->device, "CMP: cannot change channel\n"); 1383616300bdSMauro Carvalho Chehab return -EBUSY; 1384616300bdSMauro Carvalho Chehab } 1385616300bdSMauro Carvalho Chehab dev_info(fdtv->device, "CMP: overlaying connection\n"); 1386616300bdSMauro Carvalho Chehab 1387616300bdSMauro Carvalho Chehab /* We don't allocate isochronous resources. */ 1388616300bdSMauro Carvalho Chehab } else { 1389616300bdSMauro Carvalho Chehab set_opcr_channel(opcr, channel); 1390616300bdSMauro Carvalho Chehab set_opcr_data_rate(opcr, 2); /* S400 */ 1391616300bdSMauro Carvalho Chehab 1392616300bdSMauro Carvalho Chehab /* FIXME: this is for the worst case - optimize */ 1393616300bdSMauro Carvalho Chehab set_opcr_overhead_id(opcr, 0); 1394616300bdSMauro Carvalho Chehab 1395616300bdSMauro Carvalho Chehab /* FIXME: allocate isochronous channel and bandwidth at IRM */ 1396616300bdSMauro Carvalho Chehab } 1397616300bdSMauro Carvalho Chehab 1398616300bdSMauro Carvalho Chehab set_opcr_p2p_connections(opcr, get_opcr_p2p_connections(*opcr) + 1); 1399616300bdSMauro Carvalho Chehab 1400616300bdSMauro Carvalho Chehab opcr[1] = *opcr; 1401616300bdSMauro Carvalho Chehab opcr[0] = old_opcr; 1402616300bdSMauro Carvalho Chehab 1403616300bdSMauro Carvalho Chehab ret = cmp_lock(fdtv, opcr_address, opcr); 1404616300bdSMauro Carvalho Chehab if (ret < 0) 1405616300bdSMauro Carvalho Chehab return ret; 1406616300bdSMauro Carvalho Chehab 1407616300bdSMauro Carvalho Chehab if (old_opcr != *opcr) { 1408616300bdSMauro Carvalho Chehab /* 1409616300bdSMauro Carvalho Chehab * FIXME: if old_opcr.P2P_Connections > 0, 1410616300bdSMauro Carvalho Chehab * deallocate isochronous channel and bandwidth at IRM 1411616300bdSMauro Carvalho Chehab */ 1412616300bdSMauro Carvalho Chehab 1413616300bdSMauro Carvalho Chehab if (++attempts < 6) /* arbitrary limit */ 1414616300bdSMauro Carvalho Chehab goto repeat; 1415616300bdSMauro Carvalho Chehab return -EBUSY; 1416616300bdSMauro Carvalho Chehab } 1417616300bdSMauro Carvalho Chehab 1418616300bdSMauro Carvalho Chehab return 0; 1419616300bdSMauro Carvalho Chehab } 1420616300bdSMauro Carvalho Chehab 1421616300bdSMauro Carvalho Chehab void cmp_break_pp_connection(struct firedtv *fdtv, int plug, int channel) 1422616300bdSMauro Carvalho Chehab { 1423616300bdSMauro Carvalho Chehab __be32 old_opcr, opcr[2]; 1424616300bdSMauro Carvalho Chehab u64 opcr_address = CMP_OUTPUT_PLUG_CONTROL_REG_0 + (plug << 2); 1425616300bdSMauro Carvalho Chehab int attempts = 0; 1426616300bdSMauro Carvalho Chehab 1427616300bdSMauro Carvalho Chehab if (cmp_read(fdtv, opcr_address, opcr) < 0) 1428616300bdSMauro Carvalho Chehab return; 1429616300bdSMauro Carvalho Chehab 1430616300bdSMauro Carvalho Chehab repeat: 1431616300bdSMauro Carvalho Chehab if (!get_opcr_online(*opcr) || !get_opcr_p2p_connections(*opcr) || 1432616300bdSMauro Carvalho Chehab get_opcr_channel(*opcr) != channel) { 1433616300bdSMauro Carvalho Chehab dev_err(fdtv->device, "CMP: no connection to break\n"); 1434616300bdSMauro Carvalho Chehab return; 1435616300bdSMauro Carvalho Chehab } 1436616300bdSMauro Carvalho Chehab 1437616300bdSMauro Carvalho Chehab old_opcr = *opcr; 1438616300bdSMauro Carvalho Chehab set_opcr_p2p_connections(opcr, get_opcr_p2p_connections(*opcr) - 1); 1439616300bdSMauro Carvalho Chehab 1440616300bdSMauro Carvalho Chehab opcr[1] = *opcr; 1441616300bdSMauro Carvalho Chehab opcr[0] = old_opcr; 1442616300bdSMauro Carvalho Chehab 1443616300bdSMauro Carvalho Chehab if (cmp_lock(fdtv, opcr_address, opcr) < 0) 1444616300bdSMauro Carvalho Chehab return; 1445616300bdSMauro Carvalho Chehab 1446616300bdSMauro Carvalho Chehab if (old_opcr != *opcr) { 1447616300bdSMauro Carvalho Chehab /* 1448616300bdSMauro Carvalho Chehab * FIXME: if old_opcr.P2P_Connections == 1, i.e. we were last 1449616300bdSMauro Carvalho Chehab * owner, deallocate isochronous channel and bandwidth at IRM 1450616300bdSMauro Carvalho Chehab * if (...) 1451616300bdSMauro Carvalho Chehab * fdtv->backend->dealloc_resources(fdtv, channel, bw); 1452616300bdSMauro Carvalho Chehab */ 1453616300bdSMauro Carvalho Chehab 1454616300bdSMauro Carvalho Chehab if (++attempts < 6) /* arbitrary limit */ 1455616300bdSMauro Carvalho Chehab goto repeat; 1456616300bdSMauro Carvalho Chehab } 1457616300bdSMauro Carvalho Chehab } 1458