From patchwork Sun Oct 25 00:11:56 2009 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: HoP X-Patchwork-Id: 55740 Received: from vger.kernel.org (vger.kernel.org [209.132.176.167]) by demeter.kernel.org (8.14.2/8.14.2) with ESMTP id n9P0C0vO025744 for ; Sun, 25 Oct 2009 00:12:00 GMT Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1752054AbZJYALx (ORCPT ); Sat, 24 Oct 2009 20:11:53 -0400 Received: (majordomo@vger.kernel.org) by vger.kernel.org id S1752042AbZJYALx (ORCPT ); Sat, 24 Oct 2009 20:11:53 -0400 Received: from mail-bw0-f227.google.com ([209.85.218.227]:59552 "EHLO mail-bw0-f227.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1752014AbZJYALx (ORCPT ); Sat, 24 Oct 2009 20:11:53 -0400 Received: by bwz27 with SMTP id 27so1495752bwz.21 for ; Sat, 24 Oct 2009 17:11:56 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=gamma; h=domainkey-signature:mime-version:received:date:message-id:subject :from:to:content-type; bh=QL4oRViXka4/GkWCzGLkxkhkMOA1WKtboBC+1IoRdig=; b=MmteDfERpp6twumDjHfsIk6UI194mlwqREmX+UN6PjMbrivU7vj2AOrAwqvRX2LHkK naA7VXRBID17ftpwy4fGwHkZUWabZ68FWKmT2DIXbhm24aRqvleSDEtbJ2HsbG3Z4UnK RlIdslgg+W/CFc3i3tXM2tzAlR8Wn1g9mZLCI= DomainKey-Signature: a=rsa-sha1; c=nofws; d=gmail.com; s=gamma; h=mime-version:date:message-id:subject:from:to:content-type; b=jndwVvScedvKuge2gudi697LI8y4nIDE5DK4CEXb7cxp7znPvgPfVKaQe7hNRJa+Lh kXUfrN7U3UsNNNQDIeeUt1CAYyMQkU3x/OMJAC29iAkbPmtYIjcXCVR8nCEbeCPkpmLE mH5fupz60LayqpdcjWUqoEr/Hdlfn6u8a3DSw= MIME-Version: 1.0 Received: by 10.239.168.144 with SMTP id k16mr1088608hbe.103.1256429516361; Sat, 24 Oct 2009 17:11:56 -0700 (PDT) Date: Sun, 25 Oct 2009 02:11:56 +0200 Message-ID: <846899810910241711s6fb5939fq3a693a92a2a76310@mail.gmail.com> Subject: [PATCH] isl6421.c - added optional features: tone control and temporary diseqc overcurrent From: HoP To: linux-media@vger.kernel.org Sender: linux-media-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-media@vger.kernel.org diff -r f6680fa8e7ec linux/drivers/media/dvb/frontends/isl6421.c --- a/linux/drivers/media/dvb/frontends/isl6421.c Tue Oct 20 00:08:05 2009 +0900 +++ b/linux/drivers/media/dvb/frontends/isl6421.c Sun Oct 25 00:59:46 2009 +0200 @@ -3,6 +3,9 @@ * * Copyright (C) 2006 Andrew de Quincey * Copyright (C) 2006 Oliver Endriss + * Copyright (C) 2009 Ales Jurik and Jan Petrous (added optional 22k tone + * support and temporary diseqc overcurrent enable until + * next command - set voltage or tone) * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License @@ -35,12 +38,23 @@ #include "dvb_frontend.h" #include "isl6421.h" +static int tone_control = 0; +module_param(tone_control, int, S_IRUGO); +MODULE_PARM_DESC(tone_control, "Set ISL6421 to control 22kHz tone"); + +static int overcurrent_enable = 0; +module_param(overcurrent_enable, int, S_IRUGO); +MODULE_PARM_DESC(overcurrent_enable, "Set ISL6421 to temporary enable overcurrent " + "when diseqc command is active"); + struct isl6421 { u8 config; u8 override_or; u8 override_and; struct i2c_adapter *i2c; u8 i2c_addr; + int (*diseqc_send_master_cmd_orig)(struct dvb_frontend* fe, + struct dvb_diseqc_master_cmd* cmd); }; static int isl6421_set_voltage(struct dvb_frontend *fe, fe_sec_voltage_t voltage) @@ -60,6 +74,53 @@ break; case SEC_VOLTAGE_18: isl6421->config |= (ISL6421_EN1 | ISL6421_VSEL1); + break; + default: + return -EINVAL; + }; + + isl6421->config |= isl6421->override_or; + isl6421->config &= isl6421->override_and; + + return (i2c_transfer(isl6421->i2c, &msg, 1) == 1) ? 0 : -EIO; +} + +static int isl6421_send_diseqc(struct dvb_frontend *fe, + struct dvb_diseqc_master_cmd *cmd) +{ + struct isl6421 *isl6421 = (struct isl6421 *) fe->sec_priv; + struct i2c_msg msg = { .addr = isl6421->i2c_addr, .flags = 0, + .buf = &isl6421->config, + .len = sizeof(isl6421->config) }; + + isl6421->config |= ISL6421_DCL; + + isl6421->config |= isl6421->override_or; + isl6421->config &= isl6421->override_and; + + if (i2c_transfer(isl6421->i2c, &msg, 1) != 1) return -EIO; + + isl6421->config &= ~ISL6421_DCL; + + return isl6421->diseqc_send_master_cmd_orig(fe, cmd); +} + +static int isl6421_set_tone(struct dvb_frontend *fe, fe_sec_tone_mode_t tone) +{ + struct isl6421 *isl6421 = (struct isl6421 *) fe->sec_priv; + struct i2c_msg msg = { .addr = isl6421->i2c_addr, .flags = 0, + .buf = &isl6421->config, + .len = sizeof(isl6421->config) }; + + isl6421->config &= ~(ISL6421_ENT1); + + printk(KERN_INFO "%s: %s\n", __func__, ((tone == SEC_TONE_OFF) ? "Off" : "On")); + + switch(tone) { + case SEC_TONE_ON: + isl6421->config |= ISL6421_ENT1; + break; + case SEC_TONE_OFF: break; default: return -EINVAL; @@ -91,18 +152,26 @@ static void isl6421_release(struct dvb_frontend *fe) { + struct isl6421 *isl6421 = (struct isl6421 *) fe->sec_priv; + /* power off */ isl6421_set_voltage(fe, SEC_VOLTAGE_OFF); + + if(overcurrent_enable) + fe->ops.diseqc_send_master_cmd = + isl6421->diseqc_send_master_cmd_orig; /* free */ kfree(fe->sec_priv); fe->sec_priv = NULL; } -struct dvb_frontend *isl6421_attach(struct dvb_frontend *fe, struct i2c_adapter *i2c, u8 i2c_addr, - u8 override_set, u8 override_clear) +struct dvb_frontend *isl6421_attach(struct dvb_frontend *fe, + struct i2c_adapter *i2c, u8 i2c_addr, u8 override_set, + u8 override_clear) { struct isl6421 *isl6421 = kmalloc(sizeof(struct isl6421), GFP_KERNEL); + if (!isl6421) return NULL; @@ -131,6 +200,31 @@ /* override frontend ops */ fe->ops.set_voltage = isl6421_set_voltage; fe->ops.enable_high_lnb_voltage = isl6421_enable_high_lnb_voltage; + if(tone_control) + fe->ops.set_tone = isl6421_set_tone; + if(overcurrent_enable) { + if((override_set & ISL6421_DCL) || + (override_clear & ISL6421_DCL)) { + /* there is no sense to use overcurrent_enable with DCL bit set + * in any override byte */ + if(override_set & ISL6421_DCL) + printk(KERN_WARNING "ISL6421 overcurrent_enable" + " with DCL bit in override_set," + " overcurrent_enable ignored\n"); + if(override_clear & ISL6421_DCL) + printk(KERN_WARNING "ISL6421 overcurrent_enable" + " with DCL bit in override_clear," + " overcurrent_enable ignored\n"); + } else { + isl6421->diseqc_send_master_cmd_orig = + fe->ops.diseqc_send_master_cmd; + fe->ops.diseqc_send_master_cmd = isl6421_send_diseqc; + } + } + + printk(KERN_INFO "ISL6421 attached on addr=%x %s %s\n", i2c_addr, + overcurrent_enable ? "(overcurrent_enable overwritten)" : "", + tone_control ? "(tone_control overwritten)" : ""); return fe; }