// SPDX-License-Identifier: GPL-2.0 /* * ddbridge-sx8.c: Digital Devices MAX SX8 driver * * Copyright (C) 2018 Digital Devices GmbH * Marcus Metzler * Ralph Metzler * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License * version 2 only, as published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. */ #include "ddbridge.h" #include "ddbridge-io.h" #include "ddbridge-mci.h" static const u32 MCLK = (1550000000 / 12); static const u32 MAX_LDPC_BITRATE = (720000000); static const u32 MAX_DEMOD_LDPC_BITRATE = (1550000000 / 6); #define SX8_TUNER_NUM 4 #define SX8_DEMOD_NUM 8 #define SX8_DEMOD_NONE 0xff struct sx8_base { struct mci_base mci_base; u8 tuner_use_count[SX8_TUNER_NUM]; u32 gain_mode[SX8_TUNER_NUM]; u32 used_ldpc_bitrate[SX8_DEMOD_NUM]; u8 demod_in_use[SX8_DEMOD_NUM]; u32 iq_mode; u32 burst_size; u32 direct_mode; }; struct sx8 { struct mci mci; int first_time_lock; int started; struct mci_result signal_info; u32 bb_mode; u32 local_frequency; }; static void release(struct dvb_frontend *fe) { struct sx8 *state = fe->demodulator_priv; struct mci_base *mci_base = state->mci.base; mci_base->count--; if (mci_base->count == 0) { list_del(&mci_base->mci_list); kfree(mci_base); } kfree(state); } static int get_info(struct dvb_frontend *fe) { int stat; struct sx8 *state = fe->demodulator_priv; struct mci_command cmd; memset(&cmd, 0, sizeof(cmd)); cmd.command = MCI_CMD_GETSIGNALINFO; cmd.demod = state->mci.demod; stat = ddb_mci_cmd(&state->mci, &cmd, &state->signal_info); return stat; } static int get_snr(struct dvb_frontend *fe) { struct sx8 *state = fe->demodulator_priv; struct dtv_frontend_properties *p = &fe->dtv_property_cache; p->cnr.len = 1; p->cnr.stat[0].scale = FE_SCALE_DECIBEL; p->cnr.stat[0].svalue = (s64)state->signal_info.dvbs2_signal_info.signal_to_noise * 10; return 0; } static int get_strength(struct dvb_frontend *fe) { struct sx8 *state = fe->demodulator_priv; struct dtv_frontend_properties *p = &fe->dtv_property_cache; s32 str; str = 100000 - (state->signal_info.dvbs2_signal_info.channel_power * 10 + 108750); p->strength.len = 1; p->strength.stat[0].scale = FE_SCALE_DECIBEL; p->strength.stat[0].svalue = str; return 0; } static int read_status(struct dvb_frontend *fe, enum fe_status *status) { int stat; struct sx8 *state = fe->demodulator_priv; struct mci_command cmd; struct mci_result res; cmd.command = MCI_CMD_GETSTATUS; cmd.demod = state->mci.demod; stat = ddb_mci_cmd(&state->mci, &cmd, &res); if (stat) return stat; *status = 0x00; get_info(fe); get_strength(fe); if (res.status == SX8_DEMOD_WAIT_MATYPE) *status = 0x0f; if (res.status == SX8_DEMOD_LOCKED) { *status = 0x1f; get_snr(fe); } return stat; } static int mci_set_tuner(struct dvb_frontend *fe, u32 tuner, u32 on) { struct sx8 *state = fe->demodulator_priv; struct mci_base *mci_base = state->mci.base; struct sx8_base *sx8_base = (struct sx8_base *)mci_base; struct mci_command cmd; memset(&cmd, 0, sizeof(cmd)); cmd.tuner = state->mci.tuner; cmd.command = on ? SX8_CMD_INPUT_ENABLE : SX8_CMD_INPUT_DISABLE; cmd.sx8_input_enable.flags = sx8_base->gain_mode[state->mci.tuner]; return ddb_mci_cmd(&state->mci, &cmd, NULL); } static int stop(struct dvb_frontend *fe) { struct sx8 *state = fe->demodulator_priv; struct mci_base *mci_base = state->mci.base; struct sx8_base *sx8_base = (struct sx8_base *)mci_base; struct mci_command cmd; u32 input = state->mci.tuner; memset(&cmd, 0, sizeof(cmd)); if (state->mci.demod != SX8_DEMOD_NONE) { cmd.command = MCI_CMD_STOP; cmd.demod = state->mci.demod; ddb_mci_cmd(&state->mci, &cmd, NULL); if (sx8_base->iq_mode) { cmd.command = SX8_CMD_DISABLE_IQOUTPUT; cmd.demod = state->mci.demod; cmd.output = 0; ddb_mci_cmd(&state->mci, &cmd, NULL); ddb_mci_config(&state->mci, SX8_TSCONFIG_MODE_NORMAL); } } mutex_lock(&mci_base->tuner_lock); sx8_base->tuner_use_count[input]--; if (!sx8_base->tuner_use_count[input]) mci_set_tuner(fe, input, 0); if (state->mci.demod < SX8_DEMOD_NUM) { sx8_base->demod_in_use[state->mci.demod] = 0; state->mci.demod = SX8_DEMOD_NONE; } sx8_base->used_ldpc_bitrate[state->mci.nr] = 0; sx8_base->iq_mode = 0; mutex_unlock(&mci_base->tuner_lock); state->started = 0; return 0; } static int start(struct dvb_frontend *fe, u32 flags, u32 modmask, u32 ts_config) { struct sx8 *state = fe->demodulator_priv; struct mci_base *mci_base = state->mci.base; struct sx8_base *sx8_base = (struct sx8_base *)mci_base; struct dtv_frontend_properties *p = &fe->dtv_property_cache; u32 used_ldpc_bitrate = 0, free_ldpc_bitrate; u32 used_demods = 0; struct mci_command cmd; u32 input = state->mci.tuner; u32 bits_per_symbol = 0; int i = -1, stat = 0; if (p->symbol_rate >= (MCLK / 2)) flags &= ~1; if ((flags & 3) == 0) return -EINVAL; if (flags & 2) { u32 tmp = modmask; bits_per_symbol = 1; while (tmp & 1) { tmp >>= 1; bits_per_symbol++; } } mutex_lock(&mci_base->tuner_lock); if (sx8_base->iq_mode) { stat = -EBUSY; goto unlock; } if (sx8_base->direct_mode) { if (p->symbol_rate >= MCLK / 2) { if (state->mci.nr < 4) i = state->mci.nr; } else { i = state->mci.nr; } } else { for (i = 0; i < SX8_DEMOD_NUM; i++) { used_ldpc_bitrate += sx8_base->used_ldpc_bitrate[i]; if (sx8_base->demod_in_use[i]) used_demods++; } if (used_ldpc_bitrate >= MAX_LDPC_BITRATE || ((ts_config & SX8_TSCONFIG_MODE_MASK) > SX8_TSCONFIG_MODE_NORMAL && used_demods > 0)) { stat = -EBUSY; goto unlock; } free_ldpc_bitrate = MAX_LDPC_BITRATE - used_ldpc_bitrate; if (free_ldpc_bitrate > MAX_DEMOD_LDPC_BITRATE) free_ldpc_bitrate = MAX_DEMOD_LDPC_BITRATE; while (p->symbol_rate * bits_per_symbol > free_ldpc_bitrate) bits_per_symbol--; if (bits_per_symbol < 2) { stat = -EBUSY; goto unlock; } modmask &= ((1 << (bits_per_symbol - 1)) - 1); if (((flags & 0x02) != 0) && modmask == 0) { stat = -EBUSY; goto unlock; } i = (p->symbol_rate > (MCLK / 2)) ? 3 : 7; while (i >= 0 && sx8_base->demod_in_use[i]) i--; } if (i < 0) { stat = -EBUSY; goto unlock; } sx8_base->demod_in_use[i] = 1; sx8_base->used_ldpc_bitrate[state->mci.nr] = p->symbol_rate * bits_per_symbol; state->mci.demod = i; if (!sx8_base->tuner_use_count[input]) mci_set_tuner(fe, input, 1); sx8_base->tuner_use_count[input]++; sx8_base->iq_mode = (ts_config > 1); unlock: mutex_unlock(&mci_base->tuner_lock); if (stat) return stat; memset(&cmd, 0, sizeof(cmd)); if (sx8_base->iq_mode) { cmd.command = SX8_CMD_ENABLE_IQOUTPUT; cmd.demod = state->mci.demod; cmd.output = 0; ddb_mci_cmd(&state->mci, &cmd, NULL); ddb_mci_config(&state->mci, ts_config); } if (p->stream_id != NO_STREAM_ID_FILTER && p->stream_id != 0x80000000) flags |= 0x80; dev_dbg(mci_base->dev, "MCI-%d: tuner=%d demod=%d\n", state->mci.nr, state->mci.tuner, state->mci.demod); cmd.command = MCI_CMD_SEARCH_DVBS; cmd.dvbs2_search.flags = flags; cmd.dvbs2_search.s2_modulation_mask = modmask; cmd.dvbs2_search.retry = 2; cmd.dvbs2_search.frequency = p->frequency * 1000; cmd.dvbs2_search.symbol_rate = p->symbol_rate; cmd.dvbs2_search.scrambling_sequence_index = p->scrambling_sequence_index | 0x80000000; cmd.dvbs2_search.input_stream_id = (p->stream_id != NO_STREAM_ID_FILTER) ? p->stream_id : 0; cmd.tuner = state->mci.tuner; cmd.demod = state->mci.demod; cmd.output = state->mci.nr; if (p->stream_id == 0x80000000) cmd.output |= 0x80; stat = ddb_mci_cmd(&state->mci, &cmd, NULL); if (stat) stop(fe); return stat; } static int start_iq(struct dvb_frontend *fe, u32 flags, u32 roll_off, u32 ts_config) { struct sx8 *state = fe->demodulator_priv; struct mci_base *mci_base = state->mci.base; struct sx8_base *sx8_base = (struct sx8_base *)mci_base; struct dtv_frontend_properties *p = &fe->dtv_property_cache; u32 used_demods = 0; struct mci_command cmd; u32 input = state->mci.tuner; int i, stat = 0; mutex_lock(&mci_base->tuner_lock); if (sx8_base->iq_mode) { stat = -EBUSY; goto unlock; } for (i = 0; i < SX8_DEMOD_NUM; i++) if (sx8_base->demod_in_use[i]) used_demods++; if (used_demods > 0) { stat = -EBUSY; goto unlock; } state->mci.demod = 0; if (!sx8_base->tuner_use_count[input]) mci_set_tuner(fe, input, 1); sx8_base->tuner_use_count[input]++; sx8_base->iq_mode = (ts_config > 1); unlock: mutex_unlock(&mci_base->tuner_lock); if (stat) return stat; memset(&cmd, 0, sizeof(cmd)); cmd.command = SX8_CMD_START_IQ; cmd.sx8_start_iq.flags = flags; cmd.sx8_start_iq.roll_off = roll_off; cmd.sx8_start_iq.frequency = p->frequency * 1000; cmd.sx8_start_iq.symbol_rate = p->symbol_rate; cmd.tuner = state->mci.tuner; cmd.demod = state->mci.demod; stat = ddb_mci_cmd(&state->mci, &cmd, NULL); if (stat) stop(fe); ddb_mci_config(&state->mci, ts_config); return stat; } static int set_parameters(struct dvb_frontend *fe) { int stat = 0; struct sx8 *state = fe->demodulator_priv; struct dtv_frontend_properties *p = &fe->dtv_property_cache; u32 ts_config = SX8_TSCONFIG_MODE_NORMAL, iq_mode = 0, isi; if (state->started) stop(fe); isi = p->stream_id; if (isi != NO_STREAM_ID_FILTER) iq_mode = (isi & 0x30000000) >> 28; if (iq_mode) ts_config = (SX8_TSCONFIG_TSHEADER | SX8_TSCONFIG_MODE_IQ); if (iq_mode < 3) { u32 mask; switch (p->modulation) { /* uncomment whenever these modulations hit the DVB API * case APSK_256: * mask = 0x7f; * break; * case APSK_128: * mask = 0x3f; * break; * case APSK_64: * mask = 0x1f; * break; */ case APSK_32: mask = 0x0f; break; case APSK_16: mask = 0x07; break; default: mask = 0x03; break; } stat = start(fe, 3, mask, ts_config); } else { stat = start_iq(fe, 0, 4, ts_config); } if (!stat) { state->started = 1; state->first_time_lock = 1; state->signal_info.status = SX8_DEMOD_WAIT_SIGNAL; } return stat; } static int tune(struct dvb_frontend *fe, bool re_tune, unsigned int mode_flags, unsigned int *delay, enum fe_status *status) { int r; if (re_tune) { r = set_parameters(fe); if (r) return r; } r = read_status(fe, status); if (r) return r; if (*status & FE_HAS_LOCK) return 0; *delay = HZ / 10; return 0; } static enum dvbfe_algo get_algo(struct dvb_frontend *fe) { return DVBFE_ALGO_HW; } static int set_input(struct dvb_frontend *fe, int input) { struct sx8 *state = fe->demodulator_priv; struct mci_base *mci_base = state->mci.base; if (input >= SX8_TUNER_NUM) return -EINVAL; state->mci.tuner = input; dev_dbg(mci_base->dev, "MCI-%d: input=%d\n", state->mci.nr, input); return 0; } static struct dvb_frontend_ops sx8_ops = { .delsys = { SYS_DVBS, SYS_DVBS2 }, .info = { .name = "Digital Devices MaxSX8 MCI DVB-S/S2/S2X", .frequency_min_hz = 950 * MHz, .frequency_max_hz = 2150 * MHz, .symbol_rate_min = 100000, .symbol_rate_max = 100000000, .caps = FE_CAN_INVERSION_AUTO | FE_CAN_FEC_AUTO | FE_CAN_QPSK | FE_CAN_2G_MODULATION | FE_CAN_MULTISTREAM, }, .get_frontend_algo = get_algo, .tune = tune, .release = release, .read_status = read_status, }; static int init(struct mci *mci) { struct sx8 *state = (struct sx8 *)mci; state->mci.demod = SX8_DEMOD_NONE; return 0; } const struct mci_cfg ddb_max_sx8_cfg = { .type = 0, .fe_ops = &sx8_ops, .base_size = sizeof(struct sx8_base), .state_size = sizeof(struct sx8), .init = init, .set_input = set_input, };