Home | History | Annotate | Line # | Download | only in i2c
zl10353.c revision 1.3.30.2
      1  1.3.30.2   skrll /*	$NetBSD: zl10353.c,v 1.3.30.2 2017/08/28 17:52:03 skrll Exp $ */
      2       1.1  jruoho 
      3       1.1  jruoho /*-
      4       1.1  jruoho  * Copyright (c) 2011 The NetBSD Foundation, Inc.
      5       1.1  jruoho  * All rights reserved.
      6       1.1  jruoho  *
      7       1.1  jruoho  * This code is derived from software contributed to The NetBSD Foundation
      8       1.1  jruoho  * by Jukka Ruohonen.
      9       1.1  jruoho  *
     10       1.1  jruoho  * Redistribution and use in source and binary forms, with or without
     11       1.1  jruoho  * modification, are permitted provided that the following conditions
     12       1.1  jruoho  * are met:
     13       1.1  jruoho  *
     14       1.1  jruoho  * 1. Redistributions of source code must retain the above copyright
     15       1.1  jruoho  *    notice, this list of conditions and the following disclaimer.
     16       1.1  jruoho  * 2. Redistributions in binary form must reproduce the above copyright
     17       1.1  jruoho  *    notice, this list of conditions and the following disclaimer in the
     18       1.1  jruoho  *    documentation and/or other materials provided with the distribution.
     19       1.1  jruoho  *
     20       1.1  jruoho  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
     21       1.1  jruoho  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     22       1.1  jruoho  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     23       1.1  jruoho  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
     24       1.1  jruoho  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     25       1.1  jruoho  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     26       1.1  jruoho  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     27       1.1  jruoho  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     28       1.1  jruoho  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     29       1.1  jruoho  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     30       1.1  jruoho  * SUCH DAMAGE.
     31       1.1  jruoho  */
     32       1.1  jruoho #include <sys/cdefs.h>
     33  1.3.30.2   skrll __KERNEL_RCSID(0, "$NetBSD: zl10353.c,v 1.3.30.2 2017/08/28 17:52:03 skrll Exp $");
     34       1.1  jruoho 
     35       1.1  jruoho #include <sys/param.h>
     36       1.1  jruoho #include <sys/kmem.h>
     37       1.1  jruoho #include <sys/module.h>
     38       1.1  jruoho 
     39       1.1  jruoho #include <dev/dtv/dtvif.h>
     40       1.1  jruoho 
     41       1.1  jruoho #include <dev/i2c/i2cvar.h>
     42       1.1  jruoho #include <dev/i2c/zl10353reg.h>
     43       1.1  jruoho #include <dev/i2c/zl10353var.h>
     44       1.1  jruoho 
     45       1.1  jruoho /*
     46       1.1  jruoho  * Zarlink ZL10353 demodulator (now known as Intel CE623x).
     47       1.1  jruoho  *
     48       1.1  jruoho  * An incomplete datasheet:
     49       1.1  jruoho  *
     50       1.1  jruoho  *	Intel Corporation: CE6230 - COFDM demodulator with
     51       1.1  jruoho  *	USB interface for PC-TV. Data Sheet, Revision 1.1.
     52       1.1  jruoho  *	March 29, 2007.
     53       1.1  jruoho  */
     54       1.1  jruoho 
     55       1.1  jruoho static int	zl10353_probe(struct zl10353 *);
     56       1.1  jruoho static int	zl10353_read(struct zl10353 *, uint8_t, uint8_t *);
     57       1.1  jruoho static int	zl10353_write(struct zl10353 *, uint8_t, uint8_t);
     58       1.1  jruoho static int	zl10353_reset(struct zl10353 *, bool);
     59       1.1  jruoho static int	zl10353_set_agc(struct zl10353 *,
     60       1.1  jruoho 			const struct dvb_frontend_parameters *);
     61       1.1  jruoho static int	zl10353_set_bw(struct zl10353 *, fe_bandwidth_t);
     62       1.1  jruoho static int	zl10353_set_rate(struct zl10353 *);
     63       1.1  jruoho static int	zl10353_set_freq(struct zl10353 *);
     64       1.1  jruoho static int	zl10353_set_tps(struct zl10353 *,
     65       1.1  jruoho 			const struct dvb_frontend_parameters *);
     66       1.1  jruoho static int	zl10353_get_guard(fe_guard_interval_t, uint16_t *);
     67       1.1  jruoho static int	zl10353_get_mode(fe_transmit_mode_t, uint16_t *);
     68       1.1  jruoho static int	zl10353_get_fec(fe_code_rate_t, bool, uint16_t *);
     69       1.1  jruoho static int	zl10353_get_modulation(fe_modulation_t, uint16_t *);
     70       1.1  jruoho static int	zl10353_get_hier(fe_hierarchy_t, uint16_t *);
     71       1.1  jruoho 
     72       1.1  jruoho struct zl10353 *
     73       1.1  jruoho zl10353_open(device_t parent, i2c_tag_t i2c, i2c_addr_t addr)
     74       1.1  jruoho {
     75       1.1  jruoho 	struct zl10353 *zl;
     76       1.1  jruoho 
     77       1.1  jruoho 	zl = kmem_zalloc(sizeof(*zl), KM_SLEEP);
     78       1.1  jruoho 	zl->zl_i2c = i2c;
     79       1.1  jruoho 	zl->zl_i2c_addr = addr;
     80       1.1  jruoho 	zl->zl_parent = parent;
     81       1.1  jruoho 
     82       1.1  jruoho 	zl->zl_freq = ZL10353_DEFAULT_INPUT_FREQ;
     83       1.1  jruoho 	zl->zl_clock = ZL10353_DEFAULT_CLOCK_MHZ;
     84       1.1  jruoho 
     85       1.1  jruoho 	if (zl10353_reset(zl, true) != 0) {
     86       1.1  jruoho 		zl10353_close(zl);
     87       1.1  jruoho 		return NULL;
     88       1.1  jruoho 	}
     89       1.1  jruoho 
     90       1.1  jruoho 	if (zl10353_probe(zl) != 0) {
     91       1.1  jruoho 		zl10353_close(zl);
     92       1.1  jruoho 		return NULL;
     93       1.1  jruoho 	}
     94       1.1  jruoho 
     95       1.1  jruoho 	return zl;
     96       1.1  jruoho }
     97       1.1  jruoho 
     98       1.1  jruoho void
     99       1.1  jruoho zl10353_close(struct zl10353 *zl)
    100       1.1  jruoho {
    101       1.1  jruoho 	kmem_free(zl, sizeof(*zl));
    102       1.1  jruoho }
    103       1.1  jruoho 
    104       1.1  jruoho static int
    105       1.1  jruoho zl10353_probe(struct zl10353 *zl)
    106       1.1  jruoho {
    107       1.1  jruoho 	uint8_t val;
    108       1.1  jruoho 	int rv;
    109       1.1  jruoho 
    110       1.1  jruoho 	if ((rv = zl10353_read(zl, ZL10353_REG_ID, &val)) != 0)
    111       1.1  jruoho 		return rv;
    112       1.1  jruoho 
    113       1.1  jruoho 	switch (val) {
    114       1.1  jruoho 
    115       1.1  jruoho 	case ZL10353_ID_CE6230:
    116       1.1  jruoho 		zl->zl_name = "Intel CE6230";
    117       1.1  jruoho 		break;
    118       1.1  jruoho 
    119       1.1  jruoho 	case ZL10353_ID_CE6231:
    120       1.1  jruoho 		zl->zl_name = "Intel CE6231";
    121       1.1  jruoho 		break;
    122       1.1  jruoho 
    123       1.1  jruoho 	case ZL10353_ID_ZL10353:
    124       1.1  jruoho 		zl->zl_name = "Zarlink ZL10353";
    125       1.1  jruoho 		break;
    126       1.1  jruoho 
    127       1.1  jruoho 	default:
    128       1.1  jruoho 		aprint_error_dev(zl->zl_parent, "unknown chip 0x%02x\n", val);
    129       1.1  jruoho 		return ENOTSUP;
    130       1.1  jruoho 	}
    131       1.1  jruoho 
    132       1.1  jruoho 	aprint_verbose_dev(zl->zl_parent, "found %s at i2c "
    133       1.1  jruoho 	    "addr 0x%02x\n",  zl->zl_name, zl->zl_i2c_addr);
    134       1.1  jruoho 
    135       1.1  jruoho 	return 0;
    136       1.1  jruoho }
    137       1.1  jruoho 
    138       1.1  jruoho static int
    139       1.1  jruoho zl10353_read(struct zl10353 *zl, uint8_t reg, uint8_t *valp)
    140       1.1  jruoho {
    141       1.1  jruoho 	static const i2c_op_t op = I2C_OP_READ;
    142       1.1  jruoho 	int rv;
    143       1.1  jruoho 
    144       1.1  jruoho 	if ((rv = iic_acquire_bus(zl->zl_i2c, 0)) != 0)
    145       1.1  jruoho 		return rv;
    146       1.1  jruoho 
    147       1.1  jruoho 	rv = iic_exec(zl->zl_i2c, op, zl->zl_i2c_addr, &reg, 1, valp, 1, 0);
    148       1.1  jruoho 	iic_release_bus(zl->zl_i2c, 0);
    149       1.1  jruoho 
    150       1.1  jruoho 	return rv;
    151       1.1  jruoho }
    152       1.1  jruoho 
    153       1.1  jruoho static int
    154       1.1  jruoho zl10353_write(struct zl10353 *zl, uint8_t reg, uint8_t val)
    155       1.1  jruoho {
    156       1.1  jruoho 	static const i2c_op_t op = I2C_OP_WRITE;
    157       1.1  jruoho 	const uint8_t cmd[2] = { reg, val };
    158       1.1  jruoho 	int rv;
    159       1.1  jruoho 
    160       1.1  jruoho 	if ((rv = iic_acquire_bus(zl->zl_i2c, 0)) != 0)
    161       1.1  jruoho 		return rv;
    162       1.1  jruoho 
    163       1.1  jruoho 	rv = iic_exec(zl->zl_i2c, op, zl->zl_i2c_addr, cmd, 2, NULL, 0, 0);
    164       1.1  jruoho 	iic_release_bus(zl->zl_i2c, 0);
    165       1.1  jruoho 
    166       1.1  jruoho 	return rv;
    167       1.1  jruoho }
    168       1.1  jruoho 
    169       1.1  jruoho static int
    170       1.1  jruoho zl10353_reset(struct zl10353 *zl, bool hard)
    171       1.1  jruoho {
    172       1.1  jruoho 	size_t i = 0, len = 5;
    173       1.1  jruoho 	int rv;
    174       1.1  jruoho 
    175       1.1  jruoho 	static const struct {
    176       1.1  jruoho 		uint8_t		reg;
    177       1.1  jruoho 		uint8_t		val;
    178       1.1  jruoho 	} reset[] = {
    179       1.1  jruoho 		{ 0x50, 0x03 },	/* Hard */
    180       1.1  jruoho 		{ 0x03, 0x44 },
    181       1.1  jruoho 		{ 0x44, 0x46 },
    182       1.1  jruoho 		{ 0x46, 0x15 },
    183       1.1  jruoho 		{ 0x15, 0x0f },
    184       1.1  jruoho 		{ 0x55, 0x80 },	/* Soft */
    185       1.1  jruoho 		{ 0xea, 0x01 },
    186       1.1  jruoho 		{ 0xea, 0x00 },
    187       1.1  jruoho 	};
    188       1.1  jruoho 
    189       1.1  jruoho 	if (hard != true) {
    190       1.1  jruoho 		len = __arraycount(reset);
    191       1.1  jruoho 		i = 5;
    192       1.1  jruoho 	}
    193       1.1  jruoho 
    194       1.1  jruoho 	while (i < len) {
    195       1.1  jruoho 
    196       1.1  jruoho 		if ((rv = zl10353_write(zl, reset[i].reg, reset[i].val)) != 0)
    197       1.1  jruoho 			return rv;
    198       1.1  jruoho 		else {
    199       1.1  jruoho 			delay(100);
    200       1.1  jruoho 		}
    201       1.1  jruoho 
    202       1.1  jruoho 		i++;
    203       1.1  jruoho 
    204       1.1  jruoho 	}
    205       1.1  jruoho 
    206       1.1  jruoho 	return 0;
    207       1.1  jruoho }
    208       1.1  jruoho 
    209       1.1  jruoho void
    210       1.1  jruoho zl10353_get_devinfo(struct dvb_frontend_info *fi)
    211       1.1  jruoho {
    212       1.1  jruoho 
    213       1.1  jruoho 	fi->type = FE_OFDM;
    214       1.1  jruoho 
    215       1.1  jruoho 	fi->frequency_min = 174000000;
    216       1.1  jruoho 	fi->frequency_max = 862000000;
    217       1.1  jruoho 
    218       1.1  jruoho 	fi->frequency_tolerance = 0;
    219       1.1  jruoho 	fi->frequency_stepsize = 166667;
    220       1.1  jruoho 
    221       1.1  jruoho 	fi->caps |= FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
    222       1.1  jruoho 		    FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_QPSK |
    223       1.1  jruoho 	            FE_CAN_QAM_16  | FE_CAN_QAM_64  | FE_CAN_RECOVER |
    224       1.1  jruoho 		    FE_CAN_MUTE_TS;
    225       1.1  jruoho 
    226       1.1  jruoho 	fi->caps |= FE_CAN_FEC_AUTO | FE_CAN_TRANSMISSION_MODE_AUTO |
    227       1.1  jruoho 		    FE_CAN_QAM_AUTO | FE_CAN_GUARD_INTERVAL_AUTO |
    228       1.1  jruoho 		    FE_CAN_HIERARCHY_AUTO;
    229       1.1  jruoho }
    230       1.1  jruoho 
    231       1.1  jruoho int
    232       1.1  jruoho zl10353_set_params(struct zl10353 *zl,const struct dvb_frontend_parameters *fp)
    233       1.1  jruoho {
    234       1.1  jruoho 	int rv;
    235       1.1  jruoho 
    236       1.1  jruoho 	/* 1. Soft reset. */
    237       1.1  jruoho 	if ((rv = zl10353_reset(zl, false)) != 0)
    238       1.1  jruoho 		return rv;
    239       1.1  jruoho 
    240       1.1  jruoho 	/* 2. Set AGC. */
    241       1.1  jruoho 	if ((rv = zl10353_set_agc(zl, fp)) != 0)
    242       1.1  jruoho 		return rv;
    243       1.1  jruoho 
    244       1.1  jruoho 	/* 3. Set bandwidth. */
    245       1.1  jruoho 	if ((rv = zl10353_set_bw(zl, fp->u.ofdm.bandwidth)) != 0)
    246       1.1  jruoho 		return rv;
    247       1.1  jruoho 
    248       1.1  jruoho 	/* 4. Set nominal rate. */
    249       1.1  jruoho 	if ((rv = zl10353_set_rate(zl)) != 0)
    250       1.1  jruoho 		return rv;
    251       1.1  jruoho 
    252       1.1  jruoho 	/* 5. Set input frequency. */
    253       1.1  jruoho 	if ((rv = zl10353_set_freq(zl)) != 0)
    254       1.1  jruoho 		return rv;
    255       1.1  jruoho 
    256       1.1  jruoho 	/* 6. Set TPS parameters. */
    257       1.1  jruoho 	if ((rv = zl10353_set_tps(zl, fp)) != 0)
    258       1.1  jruoho 		return rv;
    259       1.1  jruoho 
    260       1.1  jruoho 	return 0;
    261       1.1  jruoho }
    262       1.1  jruoho 
    263       1.1  jruoho int
    264       1.1  jruoho zl10353_set_fsm(struct zl10353 *zl)
    265       1.1  jruoho {
    266       1.1  jruoho 	return zl10353_write(zl, ZL10353_REG_FSM, ZL10353_FSM_START);
    267       1.1  jruoho }
    268       1.1  jruoho 
    269       1.1  jruoho int
    270       1.1  jruoho zl10353_set_gate(void *aux, bool enable)
    271       1.1  jruoho {
    272       1.1  jruoho 	uint8_t val = ZL10353_GATE_DISABLE;
    273       1.1  jruoho 
    274       1.1  jruoho 	if (enable != false)
    275       1.1  jruoho 		val = ZL10353_GATE_ENABLE;
    276       1.1  jruoho 
    277       1.1  jruoho 	return zl10353_write(aux, ZL10353_REG_GATE, val);
    278       1.1  jruoho }
    279       1.1  jruoho 
    280       1.1  jruoho static int
    281       1.1  jruoho zl10353_set_agc(struct zl10353 *zl, const struct dvb_frontend_parameters *fp)
    282       1.1  jruoho {
    283       1.1  jruoho 	const struct dvb_ofdm_parameters *ofdm = &fp->u.ofdm;
    284       1.1  jruoho 	uint8_t val = ZL10353_AGC_TARGET_DEFAULT;
    285       1.1  jruoho 	int rv;
    286       1.1  jruoho 
    287       1.1  jruoho 	if ((rv = zl10353_write(zl, ZL10353_REG_AGC_TARGET, val)) != 0)
    288       1.1  jruoho 		return rv;
    289       1.1  jruoho 	else {
    290       1.1  jruoho 		val = 0;
    291       1.1  jruoho 	}
    292       1.1  jruoho 
    293       1.1  jruoho 	if (ofdm->guard_interval != GUARD_INTERVAL_AUTO)
    294       1.1  jruoho 		val |= ZL10353_AGC_CTRL_GUARD_NONAUTO;
    295       1.1  jruoho 
    296       1.1  jruoho 	if (ofdm->transmission_mode != TRANSMISSION_MODE_AUTO)
    297       1.1  jruoho 		val |= ZL10353_AGC_CTRL_MODE_NONAUTO;
    298       1.1  jruoho 
    299       1.1  jruoho 	return zl10353_write(zl, ZL10353_REG_AGC_CTRL, val);
    300       1.1  jruoho }
    301       1.1  jruoho 
    302       1.1  jruoho static int
    303       1.1  jruoho zl10353_set_bw(struct zl10353 *zl, fe_bandwidth_t bw)
    304       1.1  jruoho {
    305       1.1  jruoho 	uint8_t val[3];
    306       1.1  jruoho 	int rv;
    307       1.1  jruoho 
    308       1.1  jruoho 	switch (bw) {
    309       1.1  jruoho 
    310       1.1  jruoho 	case BANDWIDTH_6_MHZ:
    311       1.1  jruoho 		val[0] = ZL10353_BW_1_6_MHZ;
    312       1.1  jruoho 		val[1] = ZL10353_BW_2_6_MHZ;
    313       1.1  jruoho 		val[2] = ZL10353_BW_3_6_MHZ;
    314       1.1  jruoho 		zl->zl_bw = 6;
    315       1.1  jruoho 		break;
    316       1.1  jruoho 
    317       1.1  jruoho 	case BANDWIDTH_7_MHZ:
    318       1.1  jruoho 		val[0] = ZL10353_BW_1_7_MHZ;
    319       1.1  jruoho 		val[1] = ZL10353_BW_2_7_MHZ;
    320       1.1  jruoho 		val[2] = ZL10353_BW_3_7_MHZ;
    321       1.1  jruoho 		zl->zl_bw = 7;
    322       1.1  jruoho 		break;
    323       1.1  jruoho 
    324       1.1  jruoho 	case BANDWIDTH_8_MHZ:
    325       1.1  jruoho 		val[0] = ZL10353_BW_1_8_MHZ;
    326       1.1  jruoho 		val[1] = ZL10353_BW_2_8_MHZ;
    327       1.1  jruoho 		val[2] = ZL10353_BW_3_8_MHZ;
    328       1.1  jruoho 		zl->zl_bw = 8;
    329       1.1  jruoho 		break;
    330       1.1  jruoho 
    331       1.1  jruoho 	default:
    332       1.1  jruoho 		zl->zl_bw = 0;
    333       1.1  jruoho 		return EINVAL;
    334       1.1  jruoho 	}
    335       1.1  jruoho 
    336       1.1  jruoho 	if ((rv = zl10353_write(zl, ZL10353_REG_BW_1, val[0])) != 0)
    337       1.1  jruoho 		return rv;
    338       1.1  jruoho 
    339       1.1  jruoho 	if ((rv = zl10353_write(zl, ZL10353_REG_BW_2, val[1])) != 0)
    340       1.1  jruoho 		return rv;
    341       1.1  jruoho 
    342       1.1  jruoho 	if ((rv = zl10353_write(zl, ZL10353_REG_BW_3, val[2])) != 0)
    343       1.1  jruoho 		return rv;
    344       1.1  jruoho 
    345       1.1  jruoho 	return 0;
    346       1.1  jruoho }
    347       1.1  jruoho 
    348       1.1  jruoho static int
    349       1.1  jruoho zl10353_set_rate(struct zl10353 *zl)
    350       1.1  jruoho {
    351       1.1  jruoho 	static const uint64_t c = 1497965625;
    352       1.1  jruoho 	uint64_t val;
    353       1.1  jruoho 	int rv;
    354       1.1  jruoho 
    355       1.1  jruoho 	KASSERT(zl->zl_bw >= 6 && zl->zl_bw <= 8);
    356       1.1  jruoho 	KASSERT(zl->zl_clock > 0 && zl->zl_freq > 0);
    357       1.1  jruoho 
    358       1.1  jruoho 	val = zl->zl_bw * c;
    359       1.1  jruoho 	val += zl->zl_clock >> 1;
    360       1.1  jruoho 	val /= zl->zl_clock;
    361       1.1  jruoho 	val = val & 0xffff;
    362       1.1  jruoho 
    363       1.1  jruoho 	if ((rv = zl10353_write(zl, ZL10353_REG_RATE_1, val >> 8)) != 0)
    364       1.1  jruoho 		return rv;
    365       1.1  jruoho 
    366       1.1  jruoho 	return zl10353_write(zl, ZL10353_REG_RATE_2, val & 0xff);
    367       1.1  jruoho }
    368       1.1  jruoho 
    369       1.1  jruoho static int
    370       1.1  jruoho zl10353_set_freq(struct zl10353 *zl)
    371       1.1  jruoho {
    372       1.1  jruoho 	const uint16_t val = zl->zl_freq;
    373       1.1  jruoho 	int rv;
    374       1.1  jruoho 
    375       1.1  jruoho 	if ((rv = zl10353_write(zl, ZL10353_REG_FREQ_1, val >> 8)) != 0)
    376       1.1  jruoho 		return rv;
    377       1.1  jruoho 
    378       1.1  jruoho 	return zl10353_write(zl, ZL10353_REG_FREQ_2, val & 0xff);
    379       1.1  jruoho }
    380       1.1  jruoho 
    381       1.1  jruoho static int
    382       1.1  jruoho zl10353_set_tps(struct zl10353 *zl, const struct dvb_frontend_parameters *fp)
    383       1.1  jruoho {
    384       1.1  jruoho 	const struct dvb_ofdm_parameters *ofdm = &fp->u.ofdm;
    385       1.1  jruoho 	uint16_t val = 0;
    386       1.1  jruoho 	int rv;
    387       1.1  jruoho 
    388       1.1  jruoho 	if ((rv = zl10353_get_guard(ofdm->guard_interval, &val)) != 0)
    389       1.1  jruoho 		goto fail;
    390       1.1  jruoho 
    391       1.1  jruoho 	if ((rv = zl10353_get_mode(ofdm->transmission_mode, &val)) != 0)
    392       1.1  jruoho 		goto fail;
    393       1.1  jruoho 
    394       1.1  jruoho 	if ((rv = zl10353_get_fec(ofdm->code_rate_HP, true, &val)) != 0)
    395       1.1  jruoho 		goto fail;
    396       1.1  jruoho 
    397       1.1  jruoho 	if ((rv = zl10353_get_fec(ofdm->code_rate_LP, false, &val)) != 0)
    398       1.1  jruoho 		goto fail;
    399       1.1  jruoho 
    400       1.1  jruoho 	if ((rv = zl10353_get_modulation(ofdm->constellation, &val)) != 0)
    401       1.1  jruoho 		goto fail;
    402       1.1  jruoho 
    403       1.1  jruoho 	if ((rv = zl10353_get_hier(ofdm->hierarchy_information, &val)) != 0)
    404       1.1  jruoho 		goto fail;
    405       1.1  jruoho 
    406       1.1  jruoho 	if ((rv = zl10353_write(zl, ZL10353_REG_TPS_1, val >> 8)) != 0)
    407       1.1  jruoho 		goto fail;
    408       1.1  jruoho 
    409       1.1  jruoho 	if ((rv = zl10353_write(zl, ZL10353_REG_TPS_2, val & 0xff)) != 0)
    410       1.1  jruoho 		goto fail;
    411       1.1  jruoho 
    412       1.1  jruoho 	return 0;
    413       1.1  jruoho 
    414       1.1  jruoho fail:
    415       1.1  jruoho 	aprint_error_dev(zl->zl_parent, "failed to set "
    416       1.1  jruoho 	    "tps for %s (err %d)\n", zl->zl_name, rv);
    417       1.1  jruoho 
    418       1.1  jruoho 	return rv;
    419       1.1  jruoho }
    420       1.1  jruoho 
    421       1.1  jruoho static int
    422       1.1  jruoho zl10353_get_guard(fe_guard_interval_t fg, uint16_t *valp)
    423       1.1  jruoho {
    424       1.1  jruoho 
    425       1.1  jruoho 	switch (fg) {
    426       1.1  jruoho 
    427       1.1  jruoho 	case GUARD_INTERVAL_1_4:
    428       1.1  jruoho 		*valp |= ZL10353_TPS_GUARD_1_4;
    429       1.1  jruoho 		break;
    430       1.1  jruoho 
    431       1.1  jruoho 	case GUARD_INTERVAL_1_8:
    432       1.1  jruoho 		*valp |= ZL10353_TPS_GUARD_1_8;
    433       1.1  jruoho 		break;
    434       1.1  jruoho 
    435       1.1  jruoho 	case GUARD_INTERVAL_1_16:
    436       1.1  jruoho 		*valp |= ZL10353_TPS_GUARD_1_16;
    437       1.1  jruoho 		break;
    438       1.1  jruoho 
    439       1.1  jruoho 	case GUARD_INTERVAL_1_32:
    440       1.1  jruoho 		*valp |= ZL10353_TPS_GUARD_1_32;
    441       1.1  jruoho 		break;
    442       1.1  jruoho 
    443       1.1  jruoho 	case GUARD_INTERVAL_AUTO:
    444       1.1  jruoho 		*valp |= ZL10353_TPS_GUARD_AUTO;
    445       1.1  jruoho 		break;
    446       1.1  jruoho 
    447       1.1  jruoho 	default:
    448       1.1  jruoho 		return EINVAL;
    449       1.1  jruoho 	}
    450       1.1  jruoho 
    451       1.1  jruoho 	return 0;
    452       1.1  jruoho }
    453       1.1  jruoho 
    454       1.1  jruoho static int
    455       1.1  jruoho zl10353_get_mode(fe_transmit_mode_t fm, uint16_t *valp)
    456       1.1  jruoho {
    457       1.1  jruoho 
    458       1.1  jruoho 	switch (fm) {
    459       1.1  jruoho 
    460       1.1  jruoho 	case TRANSMISSION_MODE_2K:
    461       1.1  jruoho 		*valp |= ZL10353_TPS_MODE_2K;
    462       1.1  jruoho 		break;
    463       1.1  jruoho 
    464       1.1  jruoho 	case TRANSMISSION_MODE_8K:
    465       1.1  jruoho 		*valp |= ZL10353_TPS_MODE_8K;
    466       1.1  jruoho 		break;
    467       1.1  jruoho 
    468       1.1  jruoho 	case TRANSMISSION_MODE_AUTO:
    469       1.1  jruoho 		*valp |= ZL10353_TPS_MODE_AUTO;
    470       1.1  jruoho 		break;
    471       1.1  jruoho 
    472       1.1  jruoho 	default:
    473       1.1  jruoho 		return EINVAL;
    474       1.1  jruoho 	}
    475       1.1  jruoho 
    476       1.1  jruoho 	return 0;
    477       1.1  jruoho }
    478       1.1  jruoho 
    479       1.1  jruoho static int
    480       1.1  jruoho zl10353_get_fec(fe_code_rate_t fc, bool hp, uint16_t *valp)
    481       1.1  jruoho {
    482       1.1  jruoho 	uint16_t hpval = 0, lpval = 0;
    483       1.1  jruoho 
    484       1.1  jruoho 	switch (fc) {
    485       1.1  jruoho 
    486       1.1  jruoho 	case FEC_1_2:
    487       1.1  jruoho 		hpval = ZL10353_TPS_HP_FEC_1_2;
    488       1.1  jruoho 		lpval = ZL10353_TPS_LP_FEC_1_2;
    489       1.1  jruoho 		break;
    490       1.1  jruoho 
    491       1.1  jruoho 	case FEC_2_3:
    492       1.1  jruoho 		hpval = ZL10353_TPS_HP_FEC_2_3;
    493       1.1  jruoho 		lpval = ZL10353_TPS_LP_FEC_2_3;
    494       1.1  jruoho 		break;
    495       1.1  jruoho 
    496       1.1  jruoho 	case FEC_3_4:
    497       1.1  jruoho 		hpval = ZL10353_TPS_HP_FEC_3_4;
    498       1.1  jruoho 		lpval = ZL10353_TPS_LP_FEC_3_4;
    499       1.1  jruoho 		break;
    500       1.1  jruoho 
    501       1.1  jruoho 	case FEC_5_6:
    502       1.1  jruoho 		hpval = ZL10353_TPS_HP_FEC_5_6;
    503       1.1  jruoho 		lpval = ZL10353_TPS_LP_FEC_5_6;
    504       1.1  jruoho 		break;
    505       1.1  jruoho 
    506       1.1  jruoho 	case FEC_7_8:
    507       1.1  jruoho 		hpval = ZL10353_TPS_HP_FEC_7_8;
    508       1.1  jruoho 		lpval = ZL10353_TPS_LP_FEC_7_8;
    509       1.1  jruoho 		break;
    510       1.1  jruoho 
    511       1.1  jruoho 	case FEC_AUTO:
    512       1.1  jruoho 		hpval = ZL10353_TPS_HP_FEC_AUTO;
    513       1.1  jruoho 		lpval = ZL10353_TPS_LP_FEC_AUTO;
    514       1.1  jruoho 		break;
    515       1.1  jruoho 
    516       1.1  jruoho 	case FEC_NONE:
    517       1.1  jruoho 		return EOPNOTSUPP;
    518       1.1  jruoho 
    519       1.1  jruoho 	default:
    520       1.1  jruoho 		return EINVAL;
    521       1.1  jruoho 	}
    522       1.1  jruoho 
    523       1.1  jruoho 	*valp |= (hp != false) ? hpval : lpval;
    524       1.1  jruoho 
    525       1.1  jruoho 	return 0;
    526       1.1  jruoho }
    527       1.1  jruoho 
    528       1.1  jruoho static int
    529       1.1  jruoho zl10353_get_modulation(fe_modulation_t fm, uint16_t *valp)
    530       1.1  jruoho {
    531       1.1  jruoho 
    532       1.1  jruoho 	switch (fm) {
    533       1.1  jruoho 
    534       1.1  jruoho 	case QPSK:
    535       1.1  jruoho 		*valp |= ZL10353_TPS_MODULATION_QPSK;
    536       1.1  jruoho 		break;
    537       1.1  jruoho 
    538       1.1  jruoho 	case QAM_16:
    539       1.1  jruoho 		*valp |= ZL10353_TPS_MODULATION_QAM_16;
    540       1.1  jruoho 		break;
    541       1.1  jruoho 
    542       1.1  jruoho 	case QAM_64:
    543       1.1  jruoho 		*valp |= ZL10353_TPS_MODULATION_QAM_64;
    544       1.1  jruoho 		break;
    545       1.1  jruoho 
    546       1.1  jruoho 	case QAM_AUTO:
    547       1.1  jruoho 		*valp |= ZL10353_TPS_MODULATION_QAM_AUTO;
    548       1.1  jruoho 		break;
    549       1.1  jruoho 
    550       1.1  jruoho 	default:
    551       1.1  jruoho 		return EINVAL;
    552       1.1  jruoho 	}
    553       1.1  jruoho 
    554       1.1  jruoho 	return 0;
    555       1.1  jruoho }
    556       1.1  jruoho 
    557       1.1  jruoho static int
    558       1.1  jruoho zl10353_get_hier(fe_hierarchy_t fh, uint16_t *valp)
    559       1.1  jruoho {
    560       1.1  jruoho 
    561       1.1  jruoho 	switch (fh) {
    562       1.1  jruoho 
    563       1.1  jruoho 	case HIERARCHY_1:
    564       1.1  jruoho 		*valp |= ZL10353_TPS_HIERARCHY_1;
    565       1.1  jruoho 		break;
    566       1.1  jruoho 
    567       1.1  jruoho 	case HIERARCHY_2:
    568       1.1  jruoho 		*valp |= ZL10353_TPS_HIERARCHY_2;
    569       1.1  jruoho 		break;
    570       1.1  jruoho 
    571       1.1  jruoho 	case HIERARCHY_4:
    572       1.1  jruoho 		*valp |= ZL10353_TPS_HIERARCHY_4;
    573       1.1  jruoho 		break;
    574       1.1  jruoho 
    575       1.1  jruoho 	case HIERARCHY_NONE:
    576       1.1  jruoho 		*valp |= ZL10353_TPS_HIERARCHY_NONE;
    577       1.1  jruoho 		break;
    578       1.1  jruoho 
    579       1.1  jruoho 	case HIERARCHY_AUTO:
    580       1.1  jruoho 		*valp |= ZL10353_TPS_HIERARCHY_AUTO;
    581       1.1  jruoho 		break;
    582       1.1  jruoho 
    583       1.1  jruoho 	default:
    584       1.1  jruoho 		return EINVAL;
    585       1.1  jruoho 	}
    586       1.1  jruoho 
    587       1.1  jruoho 	return 0;
    588       1.1  jruoho }
    589       1.1  jruoho 
    590       1.1  jruoho fe_status_t
    591       1.1  jruoho zl10353_get_status(struct zl10353 *zl)
    592       1.1  jruoho {
    593       1.1  jruoho 	const uint8_t lock = FE_HAS_CARRIER | FE_HAS_VITERBI | FE_HAS_SYNC;
    594       1.1  jruoho 	fe_status_t fs = 0;
    595       1.1  jruoho 	uint8_t val;
    596       1.1  jruoho 
    597       1.1  jruoho 	if (zl10353_read(zl, ZL10353_REG_STATUS_LOCK, &val) == 0) {
    598       1.1  jruoho 
    599       1.1  jruoho 		if ((val & ZL10353_STATUS_LOCK_ON) != 0)
    600       1.1  jruoho 			fs |= FE_HAS_LOCK;
    601       1.1  jruoho 
    602       1.1  jruoho 		if ((val & ZL10353_STATUS_LOCK_CARRIER) != 0)
    603       1.1  jruoho 			fs |= FE_HAS_CARRIER;
    604       1.1  jruoho 
    605       1.1  jruoho 		if ((val & ZL10353_STATUS_LOCK_VITERBI) != 0)
    606       1.1  jruoho 			fs |= FE_HAS_VITERBI;
    607       1.1  jruoho 	}
    608       1.1  jruoho 
    609       1.1  jruoho 	if (zl10353_read(zl, ZL10353_REG_STATUS_SYNC, &val) == 0) {
    610       1.1  jruoho 
    611       1.1  jruoho 		if ((val & ZL10353_STATUS_SYNC_ON) != 0)
    612       1.1  jruoho 			fs |= FE_HAS_SYNC;
    613       1.1  jruoho 	}
    614       1.1  jruoho 
    615       1.1  jruoho 	if (zl10353_read(zl, ZL10353_REG_STATUS_SIGNAL, &val) == 0) {
    616       1.1  jruoho 
    617       1.1  jruoho 		if ((val & ZL10353_STATUS_SIGNAL_ON) != 0)
    618       1.1  jruoho 			fs |= FE_HAS_SIGNAL;
    619       1.1  jruoho 	}
    620       1.1  jruoho 
    621       1.1  jruoho 	return ((fs & lock) != lock) ? fs & ~FE_HAS_LOCK : fs;
    622       1.1  jruoho };
    623       1.1  jruoho 
    624       1.1  jruoho uint16_t
    625       1.1  jruoho zl10353_get_signal_strength(struct zl10353 *zl)
    626       1.1  jruoho {
    627       1.1  jruoho 	uint8_t val1, val2;
    628       1.1  jruoho 
    629       1.1  jruoho 	if (zl10353_read(zl, ZL10353_REG_SIGSTR_1, &val1) != 0)
    630       1.1  jruoho 		return 0;
    631       1.1  jruoho 
    632       1.1  jruoho 	if (zl10353_read(zl, ZL10353_REG_SIGSTR_2, &val2) != 0)
    633       1.1  jruoho 		return 0;
    634       1.1  jruoho 
    635       1.1  jruoho 	return val1 << 10 | val2 << 2 | 0x03;
    636       1.1  jruoho }
    637       1.1  jruoho 
    638       1.1  jruoho uint16_t
    639       1.1  jruoho zl10353_get_snr(struct zl10353 *zl)
    640       1.1  jruoho {
    641       1.1  jruoho 	uint8_t val;
    642       1.1  jruoho 
    643       1.1  jruoho 	if (zl10353_read(zl, ZL10353_REG_SNR, &val) != 0)
    644       1.1  jruoho 		return 0;
    645       1.1  jruoho 
    646       1.1  jruoho 	return (val << 8) | val;
    647       1.1  jruoho }
    648       1.1  jruoho 
    649  1.3.30.1   skrll MODULE(MODULE_CLASS_DRIVER, zl10353, "i2cexec");
    650       1.1  jruoho 
    651       1.1  jruoho static int
    652       1.1  jruoho zl10353_modcmd(modcmd_t cmd, void *aux)
    653       1.1  jruoho {
    654       1.1  jruoho 
    655       1.1  jruoho 	if (cmd != MODULE_CMD_INIT && cmd != MODULE_CMD_FINI)
    656       1.1  jruoho 		return ENOTTY;
    657       1.1  jruoho 
    658       1.1  jruoho 	return 0;
    659       1.1  jruoho }
    660