kernel/drivers/media/usb/as102/as10x_cmd.c

   1 /*
   2  * Abilis Systems Single DVB-T Receiver
   3  * Copyright (C) 2008 Pierrick Hascoet <pierrick.hascoet@abilis.com>
   4  * Copyright (C) 2010 Devin Heitmueller <dheitmueller@kernellabs.com>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2, or (at your option)
   9  * any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  */
  16
  17 #include <linux/kernel.h>
  18 #include "as102_drv.h"
  19 #include "as10x_cmd.h"
  20
  21 /**
  22  * as10x_cmd_turn_on - send turn on command to AS10x
  23  * @adap:   pointer to AS10x bus adapter
  24  *
  25  * Return 0 when no error, < 0 in case of error.
  26  */
  27 int as10x_cmd_turn_on(struct as10x_bus_adapter_t *adap)
  28 {
  29         int error = AS10X_CMD_ERROR;
  30         struct as10x_cmd_t *pcmd, *prsp;
  31
  32         pcmd = adap->cmd;
  33         prsp = adap->rsp;
  34
  35         /* prepare command */
  36         as10x_cmd_build(pcmd, (++adap->cmd_xid),
  37                         sizeof(pcmd->body.turn_on.req));
  38
  39         /* fill command */
  40         pcmd->body.turn_on.req.proc_id = cpu_to_le16(CONTROL_PROC_TURNON);
  41
  42         /* send command */
  43         if (adap->ops->xfer_cmd) {
  44                 error = adap->ops->xfer_cmd(adap, (uint8_t *) pcmd,
  45                                             sizeof(pcmd->body.turn_on.req) +
  46                                             HEADER_SIZE,
  47                                             (uint8_t *) prsp,
  48                                             sizeof(prsp->body.turn_on.rsp) +
  49                                             HEADER_SIZE);
  50         }
  51
  52         if (error < 0)
  53                 goto out;
  54
  55         /* parse response */
  56         error = as10x_rsp_parse(prsp, CONTROL_PROC_TURNON_RSP);
  57
  58 out:
  59         return error;
  60 }
  61
  62 /**
  63  * as10x_cmd_turn_off - send turn off command to AS10x
  64  * @adap:   pointer to AS10x bus adapter
  65  *
  66  * Return 0 on success or negative value in case of error.
  67  */
  68 int as10x_cmd_turn_off(struct as10x_bus_adapter_t *adap)
  69 {
  70         int error = AS10X_CMD_ERROR;
  71         struct as10x_cmd_t *pcmd, *prsp;
  72
  73         pcmd = adap->cmd;
  74         prsp = adap->rsp;
  75
  76         /* prepare command */
  77         as10x_cmd_build(pcmd, (++adap->cmd_xid),
  78                         sizeof(pcmd->body.turn_off.req));
  79
  80         /* fill command */
  81         pcmd->body.turn_off.req.proc_id = cpu_to_le16(CONTROL_PROC_TURNOFF);
  82
  83         /* send command */
  84         if (adap->ops->xfer_cmd) {
  85                 error = adap->ops->xfer_cmd(
  86                         adap, (uint8_t *) pcmd,
  87                         sizeof(pcmd->body.turn_off.req) + HEADER_SIZE,
  88                         (uint8_t *) prsp,
  89                         sizeof(prsp->body.turn_off.rsp) + HEADER_SIZE);
  90         }
  91
  92         if (error < 0)
  93                 goto out;
  94
  95         /* parse response */
  96         error = as10x_rsp_parse(prsp, CONTROL_PROC_TURNOFF_RSP);
  97
  98 out:
  99         return error;
 100 }
 101
 102 /**
 103  * as10x_cmd_set_tune - send set tune command to AS10x
 104  * @adap:    pointer to AS10x bus adapter
 105  * @ptune:   tune parameters
 106  *
 107  * Return 0 on success or negative value in case of error.
 108  */
 109 int as10x_cmd_set_tune(struct as10x_bus_adapter_t *adap,
 110                        struct as10x_tune_args *ptune)
 111 {
 112         int error = AS10X_CMD_ERROR;
 113         struct as10x_cmd_t *preq, *prsp;
 114
 115         preq = adap->cmd;
 116         prsp = adap->rsp;
 117
 118         /* prepare command */
 119         as10x_cmd_build(preq, (++adap->cmd_xid),
 120                         sizeof(preq->body.set_tune.req));
 121
 122         /* fill command */
 123         preq->body.set_tune.req.proc_id = cpu_to_le16(CONTROL_PROC_SETTUNE);
 124         preq->body.set_tune.req.args.freq = (__force __u32)cpu_to_le32(ptune->freq);
 125         preq->body.set_tune.req.args.bandwidth = ptune->bandwidth;
 126         preq->body.set_tune.req.args.hier_select = ptune->hier_select;
 127         preq->body.set_tune.req.args.modulation = ptune->modulation;
 128         preq->body.set_tune.req.args.hierarchy = ptune->hierarchy;
 129         preq->body.set_tune.req.args.interleaving_mode  =
 130                 ptune->interleaving_mode;
 131         preq->body.set_tune.req.args.code_rate  = ptune->code_rate;
 132         preq->body.set_tune.req.args.guard_interval = ptune->guard_interval;
 133         preq->body.set_tune.req.args.transmission_mode  =
 134                 ptune->transmission_mode;
 135
 136         /* send command */
 137         if (adap->ops->xfer_cmd) {
 138                 error = adap->ops->xfer_cmd(adap,
 139                                             (uint8_t *) preq,
 140                                             sizeof(preq->body.set_tune.req)
 141                                             + HEADER_SIZE,
 142                                             (uint8_t *) prsp,
 143                                             sizeof(prsp->body.set_tune.rsp)
 144                                             + HEADER_SIZE);
 145         }
 146
 147         if (error < 0)
 148                 goto out;
 149
 150         /* parse response */
 151         error = as10x_rsp_parse(prsp, CONTROL_PROC_SETTUNE_RSP);
 152
 153 out:
 154         return error;
 155 }
 156
 157 /**
 158  * as10x_cmd_get_tune_status - send get tune status command to AS10x
 159  * @adap: pointer to AS10x bus adapter
 160  * @pstatus: pointer to updated status structure of the current tune
 161  *
 162  * Return 0 on success or negative value in case of error.
 163  */
 164 int as10x_cmd_get_tune_status(struct as10x_bus_adapter_t *adap,
 165                               struct as10x_tune_status *pstatus)
 166 {
 167         int error = AS10X_CMD_ERROR;
 168         struct as10x_cmd_t  *preq, *prsp;
 169
 170         preq = adap->cmd;
 171         prsp = adap->rsp;
 172
 173         /* prepare command */
 174         as10x_cmd_build(preq, (++adap->cmd_xid),
 175                         sizeof(preq->body.get_tune_status.req));
 176
 177         /* fill command */
 178         preq->body.get_tune_status.req.proc_id =
 179                 cpu_to_le16(CONTROL_PROC_GETTUNESTAT);
 180
 181         /* send command */
 182         if (adap->ops->xfer_cmd) {
 183                 error = adap->ops->xfer_cmd(
 184                         adap,
 185                         (uint8_t *) preq,
 186                         sizeof(preq->body.get_tune_status.req) + HEADER_SIZE,
 187                         (uint8_t *) prsp,
 188                         sizeof(prsp->body.get_tune_status.rsp) + HEADER_SIZE);
 189         }
 190
 191         if (error < 0)
 192                 goto out;
 193
 194         /* parse response */
 195         error = as10x_rsp_parse(prsp, CONTROL_PROC_GETTUNESTAT_RSP);
 196         if (error < 0)
 197                 goto out;
 198
 199         /* Response OK -> get response data */
 200         pstatus->tune_state = prsp->body.get_tune_status.rsp.sts.tune_state;
 201         pstatus->signal_strength  =
 202                 le16_to_cpu((__force __le16)prsp->body.get_tune_status.rsp.sts.signal_strength);
 203         pstatus->PER = le16_to_cpu((__force __le16)prsp->body.get_tune_status.rsp.sts.PER);
 204         pstatus->BER = le16_to_cpu((__force __le16)prsp->body.get_tune_status.rsp.sts.BER);
 205
 206 out:
 207         return error;
 208 }
 209
 210 /**
 211  * as10x_cmd_get_tps - send get TPS command to AS10x
 212  * @adap:      pointer to AS10x handle
 213  * @ptps:      pointer to TPS parameters structure
 214  *
 215  * Return 0 on success or negative value in case of error.
 216  */
 217 int as10x_cmd_get_tps(struct as10x_bus_adapter_t *adap, struct as10x_tps *ptps)
 218 {
 219         int error = AS10X_CMD_ERROR;
 220         struct as10x_cmd_t *pcmd, *prsp;
 221
 222         pcmd = adap->cmd;
 223         prsp = adap->rsp;
 224
 225         /* prepare command */
 226         as10x_cmd_build(pcmd, (++adap->cmd_xid),
 227                         sizeof(pcmd->body.get_tps.req));
 228
 229         /* fill command */
 230         pcmd->body.get_tune_status.req.proc_id =
 231                 cpu_to_le16(CONTROL_PROC_GETTPS);
 232
 233         /* send command */
 234         if (adap->ops->xfer_cmd) {
 235                 error = adap->ops->xfer_cmd(adap,
 236                                             (uint8_t *) pcmd,
 237                                             sizeof(pcmd->body.get_tps.req) +
 238                                             HEADER_SIZE,
 239                                             (uint8_t *) prsp,
 240                                             sizeof(prsp->body.get_tps.rsp) +
 241                                             HEADER_SIZE);
 242         }
 243
 244         if (error < 0)
 245                 goto out;
 246
 247         /* parse response */
 248         error = as10x_rsp_parse(prsp, CONTROL_PROC_GETTPS_RSP);
 249         if (error < 0)
 250                 goto out;
 251
 252         /* Response OK -> get response data */
 253         ptps->modulation = prsp->body.get_tps.rsp.tps.modulation;
 254         ptps->hierarchy = prsp->body.get_tps.rsp.tps.hierarchy;
 255         ptps->interleaving_mode = prsp->body.get_tps.rsp.tps.interleaving_mode;
 256         ptps->code_rate_HP = prsp->body.get_tps.rsp.tps.code_rate_HP;
 257         ptps->code_rate_LP = prsp->body.get_tps.rsp.tps.code_rate_LP;
 258         ptps->guard_interval = prsp->body.get_tps.rsp.tps.guard_interval;
 259         ptps->transmission_mode  = prsp->body.get_tps.rsp.tps.transmission_mode;
 260         ptps->DVBH_mask_HP = prsp->body.get_tps.rsp.tps.DVBH_mask_HP;
 261         ptps->DVBH_mask_LP = prsp->body.get_tps.rsp.tps.DVBH_mask_LP;
 262         ptps->cell_ID = le16_to_cpu((__force __le16)prsp->body.get_tps.rsp.tps.cell_ID);
 263
 264 out:
 265         return error;
 266 }
 267
 268 /**
 269  * as10x_cmd_get_demod_stats - send get demod stats command to AS10x
 270  * @adap:          pointer to AS10x bus adapter
 271  * @pdemod_stats:  pointer to demod stats parameters structure
 272  *
 273  * Return 0 on success or negative value in case of error.
 274  */
 275 int as10x_cmd_get_demod_stats(struct as10x_bus_adapter_t *adap,
 276                               struct as10x_demod_stats *pdemod_stats)
 277 {
 278         int error = AS10X_CMD_ERROR;
 279         struct as10x_cmd_t *pcmd, *prsp;
 280
 281         pcmd = adap->cmd;
 282         prsp = adap->rsp;
 283
 284         /* prepare command */
 285         as10x_cmd_build(pcmd, (++adap->cmd_xid),
 286                         sizeof(pcmd->body.get_demod_stats.req));
 287
 288         /* fill command */
 289         pcmd->body.get_demod_stats.req.proc_id =
 290                 cpu_to_le16(CONTROL_PROC_GET_DEMOD_STATS);
 291
 292         /* send command */
 293         if (adap->ops->xfer_cmd) {
 294                 error = adap->ops->xfer_cmd(adap,
 295                                 (uint8_t *) pcmd,
 296                                 sizeof(pcmd->body.get_demod_stats.req)
 297                                 + HEADER_SIZE,
 298                                 (uint8_t *) prsp,
 299                                 sizeof(prsp->body.get_demod_stats.rsp)
 300                                 + HEADER_SIZE);
 301         }
 302
 303         if (error < 0)
 304                 goto out;
 305
 306         /* parse response */
 307         error = as10x_rsp_parse(prsp, CONTROL_PROC_GET_DEMOD_STATS_RSP);
 308         if (error < 0)
 309                 goto out;
 310
 311         /* Response OK -> get response data */
 312         pdemod_stats->frame_count =
 313                 le32_to_cpu((__force __le32)prsp->body.get_demod_stats.rsp.stats.frame_count);
 314         pdemod_stats->bad_frame_count =
 315                 le32_to_cpu((__force __le32)prsp->body.get_demod_stats.rsp.stats.bad_frame_count);
 316         pdemod_stats->bytes_fixed_by_rs =
 317                 le32_to_cpu((__force __le32)prsp->body.get_demod_stats.rsp.stats.bytes_fixed_by_rs);
 318         pdemod_stats->mer =
 319                 le16_to_cpu((__force __le16)prsp->body.get_demod_stats.rsp.stats.mer);
 320         pdemod_stats->has_started =
 321                 prsp->body.get_demod_stats.rsp.stats.has_started;
 322
 323 out:
 324         return error;
 325 }
 326
 327 /**
 328  * as10x_cmd_get_impulse_resp - send get impulse response command to AS10x
 329  * @adap:     pointer to AS10x bus adapter
 330  * @is_ready: pointer to value indicating when impulse
 331  *            response data is ready
 332  *
 333  * Return 0 on success or negative value in case of error.
 334  */
 335 int as10x_cmd_get_impulse_resp(struct as10x_bus_adapter_t *adap,
 336                                uint8_t *is_ready)
 337 {
 338         int error = AS10X_CMD_ERROR;
 339         struct as10x_cmd_t *pcmd, *prsp;
 340
 341         pcmd = adap->cmd;
 342         prsp = adap->rsp;
 343
 344         /* prepare command */
 345         as10x_cmd_build(pcmd, (++adap->cmd_xid),
 346                         sizeof(pcmd->body.get_impulse_rsp.req));
 347
 348         /* fill command */
 349         pcmd->body.get_impulse_rsp.req.proc_id =
 350                 cpu_to_le16(CONTROL_PROC_GET_IMPULSE_RESP);
 351
 352         /* send command */
 353         if (adap->ops->xfer_cmd) {
 354                 error = adap->ops->xfer_cmd(adap,
 355                                         (uint8_t *) pcmd,
 356                                         sizeof(pcmd->body.get_impulse_rsp.req)
 357                                         + HEADER_SIZE,
 358                                         (uint8_t *) prsp,
 359                                         sizeof(prsp->body.get_impulse_rsp.rsp)
 360                                         + HEADER_SIZE);
 361         }
 362
 363         if (error < 0)
 364                 goto out;
 365
 366         /* parse response */
 367         error = as10x_rsp_parse(prsp, CONTROL_PROC_GET_IMPULSE_RESP_RSP);
 368         if (error < 0)
 369                 goto out;
 370
 371         /* Response OK -> get response data */
 372         *is_ready = prsp->body.get_impulse_rsp.rsp.is_ready;
 373
 374 out:
 375         return error;
 376 }
 377
 378 /**
 379  * as10x_cmd_build - build AS10x command header
 380  * @pcmd:     pointer to AS10x command buffer
 381  * @xid:      sequence id of the command
 382  * @cmd_len:  length of the command
 383  */
 384 void as10x_cmd_build(struct as10x_cmd_t *pcmd,
 385                      uint16_t xid, uint16_t cmd_len)
 386 {
 387         pcmd->header.req_id = cpu_to_le16(xid);
 388         pcmd->header.prog = cpu_to_le16(SERVICE_PROG_ID);
 389         pcmd->header.version = cpu_to_le16(SERVICE_PROG_VERSION);
 390         pcmd->header.data_len = cpu_to_le16(cmd_len);
 391 }
 392
 393 /**
 394  * as10x_rsp_parse - Parse command response
 395  * @prsp:       pointer to AS10x command buffer
 396  * @proc_id:    id of the command
 397  *
 398  * Return 0 on success or negative value in case of error.
 399  */
 400 int as10x_rsp_parse(struct as10x_cmd_t *prsp, uint16_t proc_id)
 401 {
 402         int error;
 403
 404         /* extract command error code */
 405         error = prsp->body.common.rsp.error;
 406
 407         if ((error == 0) &&
 408             (le16_to_cpu(prsp->body.common.rsp.proc_id) == proc_id)) {
 409                 return 0;
 410         }
 411
 412         return AS10X_CMD_ERROR;
 413 }