1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * ddbridge-sx8.c: Digital Devices MAX SX8 driver 4 * 5 * Copyright (C) 2018 Digital Devices GmbH 6 * Marcus Metzler <mocm@metzlerbros.de> 7 * Ralph Metzler <rjkm@metzlerbros.de> 8 * 9 * This program is free software; you can redistribute it and/or 10 * modify it under the terms of the GNU General Public License 11 * version 2 only, as published by the Free Software Foundation. 12 * 13 * This program is distributed in the hope that it will be useful, 14 * but WITHOUT ANY WARRANTY; without even the implied warranty of 15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 16 * GNU General Public License for more details. 17 */ 18 19 #include "ddbridge.h" 20 #include "ddbridge-io.h" 21 #include "ddbridge-mci.h" 22 23 static const u32 MCLK = (1550000000 / 12); 24 static const u32 MAX_LDPC_BITRATE = (720000000); 25 static const u32 MAX_DEMOD_LDPC_BITRATE = (1550000000 / 6); 26 27 #define SX8_TUNER_NUM 4 28 #define SX8_DEMOD_NUM 8 29 #define SX8_DEMOD_NONE 0xff 30 31 struct sx8_base { 32 struct mci_base mci_base; 33 34 u8 tuner_use_count[SX8_TUNER_NUM]; 35 u32 gain_mode[SX8_TUNER_NUM]; 36 37 u32 used_ldpc_bitrate[SX8_DEMOD_NUM]; 38 u8 demod_in_use[SX8_DEMOD_NUM]; 39 u32 iq_mode; 40 u32 burst_size; 41 u32 direct_mode; 42 }; 43 44 struct sx8 { 45 struct mci mci; 46 47 int first_time_lock; 48 int started; 49 struct mci_result signal_info; 50 51 u32 bb_mode; 52 u32 local_frequency; 53 }; 54 55 static void release(struct dvb_frontend *fe) 56 { 57 struct sx8 *state = fe->demodulator_priv; 58 struct mci_base *mci_base = state->mci.base; 59 60 mci_base->count--; 61 if (mci_base->count == 0) { 62 list_del(&mci_base->mci_list); 63 kfree(mci_base); 64 } 65 kfree(state); 66 } 67 68 static int get_info(struct dvb_frontend *fe) 69 { 70 int stat; 71 struct sx8 *state = fe->demodulator_priv; 72 struct mci_command cmd; 73 74 memset(&cmd, 0, sizeof(cmd)); 75 cmd.command = MCI_CMD_GETSIGNALINFO; 76 cmd.demod = state->mci.demod; 77 stat = ddb_mci_cmd(&state->mci, &cmd, &state->signal_info); 78 return stat; 79 } 80 81 static int get_snr(struct dvb_frontend *fe) 82 { 83 struct sx8 *state = fe->demodulator_priv; 84 struct dtv_frontend_properties *p = &fe->dtv_property_cache; 85 86 p->cnr.len = 1; 87 p->cnr.stat[0].scale = FE_SCALE_DECIBEL; 88 p->cnr.stat[0].svalue = 89 (s64)state->signal_info.dvbs2_signal_info.signal_to_noise 90 * 10; 91 return 0; 92 } 93 94 static int get_strength(struct dvb_frontend *fe) 95 { 96 struct sx8 *state = fe->demodulator_priv; 97 struct dtv_frontend_properties *p = &fe->dtv_property_cache; 98 s32 str; 99 100 str = 100000 - 101 (state->signal_info.dvbs2_signal_info.channel_power 102 * 10 + 108750); 103 p->strength.len = 1; 104 p->strength.stat[0].scale = FE_SCALE_DECIBEL; 105 p->strength.stat[0].svalue = str; 106 return 0; 107 } 108 109 static int read_status(struct dvb_frontend *fe, enum fe_status *status) 110 { 111 int stat; 112 struct sx8 *state = fe->demodulator_priv; 113 struct mci_command cmd; 114 struct mci_result res; 115 116 cmd.command = MCI_CMD_GETSTATUS; 117 cmd.demod = state->mci.demod; 118 stat = ddb_mci_cmd(&state->mci, &cmd, &res); 119 if (stat) 120 return stat; 121 *status = 0x00; 122 get_info(fe); 123 get_strength(fe); 124 if (res.status == SX8_DEMOD_WAIT_MATYPE) 125 *status = 0x0f; 126 if (res.status == SX8_DEMOD_LOCKED) { 127 *status = 0x1f; 128 get_snr(fe); 129 } 130 return stat; 131 } 132 133 static int mci_set_tuner(struct dvb_frontend *fe, u32 tuner, u32 on) 134 { 135 struct sx8 *state = fe->demodulator_priv; 136 struct mci_base *mci_base = state->mci.base; 137 struct sx8_base *sx8_base = (struct sx8_base *)mci_base; 138 struct mci_command cmd; 139 140 memset(&cmd, 0, sizeof(cmd)); 141 cmd.tuner = state->mci.tuner; 142 cmd.command = on ? SX8_CMD_INPUT_ENABLE : SX8_CMD_INPUT_DISABLE; 143 cmd.sx8_input_enable.flags = sx8_base->gain_mode[state->mci.tuner]; 144 return ddb_mci_cmd(&state->mci, &cmd, NULL); 145 } 146 147 static int stop(struct dvb_frontend *fe) 148 { 149 struct sx8 *state = fe->demodulator_priv; 150 struct mci_base *mci_base = state->mci.base; 151 struct sx8_base *sx8_base = (struct sx8_base *)mci_base; 152 struct mci_command cmd; 153 u32 input = state->mci.tuner; 154 155 memset(&cmd, 0, sizeof(cmd)); 156 if (state->mci.demod != SX8_DEMOD_NONE) { 157 cmd.command = MCI_CMD_STOP; 158 cmd.demod = state->mci.demod; 159 ddb_mci_cmd(&state->mci, &cmd, NULL); 160 if (sx8_base->iq_mode) { 161 cmd.command = SX8_CMD_DISABLE_IQOUTPUT; 162 cmd.demod = state->mci.demod; 163 cmd.output = 0; 164 ddb_mci_cmd(&state->mci, &cmd, NULL); 165 ddb_mci_config(&state->mci, SX8_TSCONFIG_MODE_NORMAL); 166 } 167 } 168 mutex_lock(&mci_base->tuner_lock); 169 sx8_base->tuner_use_count[input]--; 170 if (!sx8_base->tuner_use_count[input]) 171 mci_set_tuner(fe, input, 0); 172 if (state->mci.demod < SX8_DEMOD_NUM) { 173 sx8_base->demod_in_use[state->mci.demod] = 0; 174 state->mci.demod = SX8_DEMOD_NONE; 175 } 176 sx8_base->used_ldpc_bitrate[state->mci.nr] = 0; 177 sx8_base->iq_mode = 0; 178 mutex_unlock(&mci_base->tuner_lock); 179 state->started = 0; 180 return 0; 181 } 182 183 static int start(struct dvb_frontend *fe, u32 flags, u32 modmask, u32 ts_config) 184 { 185 struct sx8 *state = fe->demodulator_priv; 186 struct mci_base *mci_base = state->mci.base; 187 struct sx8_base *sx8_base = (struct sx8_base *)mci_base; 188 struct dtv_frontend_properties *p = &fe->dtv_property_cache; 189 u32 used_ldpc_bitrate = 0, free_ldpc_bitrate; 190 u32 used_demods = 0; 191 struct mci_command cmd; 192 u32 input = state->mci.tuner; 193 u32 bits_per_symbol = 0; 194 int i = -1, stat = 0; 195 196 if (p->symbol_rate >= (MCLK / 2)) 197 flags &= ~1; 198 if ((flags & 3) == 0) 199 return -EINVAL; 200 201 if (flags & 2) { 202 u32 tmp = modmask; 203 204 bits_per_symbol = 1; 205 while (tmp & 1) { 206 tmp >>= 1; 207 bits_per_symbol++; 208 } 209 } 210 211 mutex_lock(&mci_base->tuner_lock); 212 if (sx8_base->iq_mode) { 213 stat = -EBUSY; 214 goto unlock; 215 } 216 217 if (sx8_base->direct_mode) { 218 if (p->symbol_rate >= MCLK / 2) { 219 if (state->mci.nr < 4) 220 i = state->mci.nr; 221 } else { 222 i = state->mci.nr; 223 } 224 } else { 225 for (i = 0; i < SX8_DEMOD_NUM; i++) { 226 used_ldpc_bitrate += sx8_base->used_ldpc_bitrate[i]; 227 if (sx8_base->demod_in_use[i]) 228 used_demods++; 229 } 230 if (used_ldpc_bitrate >= MAX_LDPC_BITRATE || 231 ((ts_config & SX8_TSCONFIG_MODE_MASK) > 232 SX8_TSCONFIG_MODE_NORMAL && used_demods > 0)) { 233 stat = -EBUSY; 234 goto unlock; 235 } 236 free_ldpc_bitrate = MAX_LDPC_BITRATE - used_ldpc_bitrate; 237 if (free_ldpc_bitrate > MAX_DEMOD_LDPC_BITRATE) 238 free_ldpc_bitrate = MAX_DEMOD_LDPC_BITRATE; 239 240 while (p->symbol_rate * bits_per_symbol > free_ldpc_bitrate) 241 bits_per_symbol--; 242 if (bits_per_symbol < 2) { 243 stat = -EBUSY; 244 goto unlock; 245 } 246 247 modmask &= ((1 << (bits_per_symbol - 1)) - 1); 248 if (((flags & 0x02) != 0) && modmask == 0) { 249 stat = -EBUSY; 250 goto unlock; 251 } 252 253 i = (p->symbol_rate > (MCLK / 2)) ? 3 : 7; 254 while (i >= 0 && sx8_base->demod_in_use[i]) 255 i--; 256 } 257 258 if (i < 0) { 259 stat = -EBUSY; 260 goto unlock; 261 } 262 sx8_base->demod_in_use[i] = 1; 263 sx8_base->used_ldpc_bitrate[state->mci.nr] = p->symbol_rate 264 * bits_per_symbol; 265 state->mci.demod = i; 266 267 if (!sx8_base->tuner_use_count[input]) 268 mci_set_tuner(fe, input, 1); 269 sx8_base->tuner_use_count[input]++; 270 sx8_base->iq_mode = (ts_config > 1); 271 unlock: 272 mutex_unlock(&mci_base->tuner_lock); 273 if (stat) 274 return stat; 275 memset(&cmd, 0, sizeof(cmd)); 276 277 if (sx8_base->iq_mode) { 278 cmd.command = SX8_CMD_ENABLE_IQOUTPUT; 279 cmd.demod = state->mci.demod; 280 cmd.output = 0; 281 ddb_mci_cmd(&state->mci, &cmd, NULL); 282 ddb_mci_config(&state->mci, ts_config); 283 } 284 if (p->stream_id != NO_STREAM_ID_FILTER && p->stream_id != 0x80000000) 285 flags |= 0x80; 286 dev_dbg(mci_base->dev, "MCI-%d: tuner=%d demod=%d\n", 287 state->mci.nr, state->mci.tuner, state->mci.demod); 288 cmd.command = MCI_CMD_SEARCH_DVBS; 289 cmd.dvbs2_search.flags = flags; 290 cmd.dvbs2_search.s2_modulation_mask = modmask; 291 cmd.dvbs2_search.retry = 2; 292 cmd.dvbs2_search.frequency = p->frequency * 1000; 293 cmd.dvbs2_search.symbol_rate = p->symbol_rate; 294 cmd.dvbs2_search.scrambling_sequence_index = 295 p->scrambling_sequence_index | 0x80000000; 296 cmd.dvbs2_search.input_stream_id = 297 (p->stream_id != NO_STREAM_ID_FILTER) ? p->stream_id : 0; 298 cmd.tuner = state->mci.tuner; 299 cmd.demod = state->mci.demod; 300 cmd.output = state->mci.nr; 301 if (p->stream_id == 0x80000000) 302 cmd.output |= 0x80; 303 stat = ddb_mci_cmd(&state->mci, &cmd, NULL); 304 if (stat) 305 stop(fe); 306 return stat; 307 } 308 309 static int start_iq(struct dvb_frontend *fe, u32 flags, u32 roll_off, 310 u32 ts_config) 311 { 312 struct sx8 *state = fe->demodulator_priv; 313 struct mci_base *mci_base = state->mci.base; 314 struct sx8_base *sx8_base = (struct sx8_base *)mci_base; 315 struct dtv_frontend_properties *p = &fe->dtv_property_cache; 316 u32 used_demods = 0; 317 struct mci_command cmd; 318 u32 input = state->mci.tuner; 319 int i, stat = 0; 320 321 mutex_lock(&mci_base->tuner_lock); 322 if (sx8_base->iq_mode) { 323 stat = -EBUSY; 324 goto unlock; 325 } 326 for (i = 0; i < SX8_DEMOD_NUM; i++) 327 if (sx8_base->demod_in_use[i]) 328 used_demods++; 329 if (used_demods > 0) { 330 stat = -EBUSY; 331 goto unlock; 332 } 333 state->mci.demod = 0; 334 if (!sx8_base->tuner_use_count[input]) 335 mci_set_tuner(fe, input, 1); 336 sx8_base->tuner_use_count[input]++; 337 sx8_base->iq_mode = (ts_config > 1); 338 unlock: 339 mutex_unlock(&mci_base->tuner_lock); 340 if (stat) 341 return stat; 342 343 memset(&cmd, 0, sizeof(cmd)); 344 cmd.command = SX8_CMD_START_IQ; 345 cmd.sx8_start_iq.flags = flags; 346 cmd.sx8_start_iq.roll_off = roll_off; 347 cmd.sx8_start_iq.frequency = p->frequency * 1000; 348 cmd.sx8_start_iq.symbol_rate = p->symbol_rate; 349 cmd.tuner = state->mci.tuner; 350 cmd.demod = state->mci.demod; 351 stat = ddb_mci_cmd(&state->mci, &cmd, NULL); 352 if (stat) 353 stop(fe); 354 ddb_mci_config(&state->mci, ts_config); 355 return stat; 356 } 357 358 static int set_parameters(struct dvb_frontend *fe) 359 { 360 int stat = 0; 361 struct sx8 *state = fe->demodulator_priv; 362 struct dtv_frontend_properties *p = &fe->dtv_property_cache; 363 u32 ts_config = SX8_TSCONFIG_MODE_NORMAL, iq_mode = 0, isi; 364 365 if (state->started) 366 stop(fe); 367 368 isi = p->stream_id; 369 if (isi != NO_STREAM_ID_FILTER) 370 iq_mode = (isi & 0x30000000) >> 28; 371 372 if (iq_mode) 373 ts_config = (SX8_TSCONFIG_TSHEADER | SX8_TSCONFIG_MODE_IQ); 374 if (iq_mode < 3) { 375 u32 mask; 376 377 switch (p->modulation) { 378 /* uncomment whenever these modulations hit the DVB API 379 * case APSK_256: 380 * mask = 0x7f; 381 * break; 382 * case APSK_128: 383 * mask = 0x3f; 384 * break; 385 * case APSK_64: 386 * mask = 0x1f; 387 * break; 388 */ 389 case APSK_32: 390 mask = 0x0f; 391 break; 392 case APSK_16: 393 mask = 0x07; 394 break; 395 default: 396 mask = 0x03; 397 break; 398 } 399 stat = start(fe, 3, mask, ts_config); 400 } else { 401 u32 flags = (iq_mode == 2) ? 1 : 0; 402 403 stat = start_iq(fe, flags, 4, ts_config); 404 } 405 if (!stat) { 406 state->started = 1; 407 state->first_time_lock = 1; 408 state->signal_info.status = SX8_DEMOD_WAIT_SIGNAL; 409 } 410 411 return stat; 412 } 413 414 static int tune(struct dvb_frontend *fe, bool re_tune, 415 unsigned int mode_flags, 416 unsigned int *delay, enum fe_status *status) 417 { 418 int r; 419 420 if (re_tune) { 421 r = set_parameters(fe); 422 if (r) 423 return r; 424 } 425 r = read_status(fe, status); 426 if (r) 427 return r; 428 429 if (*status & FE_HAS_LOCK) 430 return 0; 431 *delay = HZ / 10; 432 return 0; 433 } 434 435 static enum dvbfe_algo get_algo(struct dvb_frontend *fe) 436 { 437 return DVBFE_ALGO_HW; 438 } 439 440 static int set_input(struct dvb_frontend *fe, int input) 441 { 442 struct sx8 *state = fe->demodulator_priv; 443 struct mci_base *mci_base = state->mci.base; 444 445 if (input >= SX8_TUNER_NUM) 446 return -EINVAL; 447 448 state->mci.tuner = input; 449 dev_dbg(mci_base->dev, "MCI-%d: input=%d\n", state->mci.nr, input); 450 return 0; 451 } 452 453 static struct dvb_frontend_ops sx8_ops = { 454 .delsys = { SYS_DVBS, SYS_DVBS2 }, 455 .info = { 456 .name = "Digital Devices MaxSX8 MCI DVB-S/S2/S2X", 457 .frequency_min_hz = 950 * MHz, 458 .frequency_max_hz = 2150 * MHz, 459 .symbol_rate_min = 100000, 460 .symbol_rate_max = 100000000, 461 .caps = FE_CAN_INVERSION_AUTO | 462 FE_CAN_FEC_AUTO | 463 FE_CAN_QPSK | 464 FE_CAN_2G_MODULATION | 465 FE_CAN_MULTISTREAM, 466 }, 467 .get_frontend_algo = get_algo, 468 .tune = tune, 469 .release = release, 470 .read_status = read_status, 471 }; 472 473 static int init(struct mci *mci) 474 { 475 struct sx8 *state = (struct sx8 *)mci; 476 477 state->mci.demod = SX8_DEMOD_NONE; 478 return 0; 479 } 480 481 const struct mci_cfg ddb_max_sx8_cfg = { 482 .type = 0, 483 .fe_ops = &sx8_ops, 484 .base_size = sizeof(struct sx8_base), 485 .state_size = sizeof(struct sx8), 486 .init = init, 487 .set_input = set_input, 488 }; 489