LXR linux/drivers/media/platform/s5p-mfc/s5p_mfc_cmd

   1/*
   2 * linux/drivers/media/platform/s5p-mfc/s5p_mfc_cmd_v5.c
   3 *
   4 * Copyright (C) 2011 Samsung Electronics Co., Ltd.
   5 *              http://www.samsung.com/
   6 *
   7 * This program is free software; you can redistribute it and/or modify
   8 * it under the terms of the GNU General Public License as published by
   9 * the Free Software Foundation; either version 2 of the License, or
  10 * (at your option) any later version.
  11 */
  12
  13#include "regs-mfc.h"
  14#include "s5p_mfc_cmd.h"
  15#include "s5p_mfc_common.h"
  16#include "s5p_mfc_debug.h"
  17
  18/* This function is used to send a command to the MFC */
  19static int s5p_mfc_cmd_host2risc_v5(struct s5p_mfc_dev *dev, int cmd,
  20                                struct s5p_mfc_cmd_args *args)
  21{
  22        int cur_cmd;
  23        unsigned long timeout;
  24
  25        timeout = jiffies + msecs_to_jiffies(MFC_BW_TIMEOUT);
  26        /* wait until host to risc command register becomes 'H2R_CMD_EMPTY' */
  27        do {
  28                if (time_after(jiffies, timeout)) {
  29                        mfc_err("Timeout while waiting for hardware\n");
  30                        return -EIO;
  31                }
  32                cur_cmd = mfc_read(dev, S5P_FIMV_HOST2RISC_CMD);
  33        } while (cur_cmd != S5P_FIMV_H2R_CMD_EMPTY);
  34        mfc_write(dev, args->arg[0], S5P_FIMV_HOST2RISC_ARG1);
  35        mfc_write(dev, args->arg[1], S5P_FIMV_HOST2RISC_ARG2);
  36        mfc_write(dev, args->arg[2], S5P_FIMV_HOST2RISC_ARG3);
  37        mfc_write(dev, args->arg[3], S5P_FIMV_HOST2RISC_ARG4);
  38        /* Issue the command */
  39        mfc_write(dev, cmd, S5P_FIMV_HOST2RISC_CMD);
  40        return 0;
  41}
  42
  43/* Initialize the MFC */
  44static int s5p_mfc_sys_init_cmd_v5(struct s5p_mfc_dev *dev)
  45{
  46        struct s5p_mfc_cmd_args h2r_args;
  47
  48        memset(&h2r_args, 0, sizeof(struct s5p_mfc_cmd_args));
  49        h2r_args.arg[0] = dev->fw_size;
  50        return s5p_mfc_cmd_host2risc_v5(dev, S5P_FIMV_H2R_CMD_SYS_INIT,
  51                        &h2r_args);
  52}
  53
  54/* Suspend the MFC hardware */
  55static int s5p_mfc_sleep_cmd_v5(struct s5p_mfc_dev *dev)
  56{
  57        struct s5p_mfc_cmd_args h2r_args;
  58
  59        memset(&h2r_args, 0, sizeof(struct s5p_mfc_cmd_args));
  60        return s5p_mfc_cmd_host2risc_v5(dev, S5P_FIMV_H2R_CMD_SLEEP, &h2r_args);
  61}
  62
  63/* Wake up the MFC hardware */
  64static int s5p_mfc_wakeup_cmd_v5(struct s5p_mfc_dev *dev)
  65{
  66        struct s5p_mfc_cmd_args h2r_args;
  67
  68        memset(&h2r_args, 0, sizeof(struct s5p_mfc_cmd_args));
  69        return s5p_mfc_cmd_host2risc_v5(dev, S5P_FIMV_H2R_CMD_WAKEUP,
  70                        &h2r_args);
  71}
  72
  73
  74static int s5p_mfc_open_inst_cmd_v5(struct s5p_mfc_ctx *ctx)
  75{
  76        struct s5p_mfc_dev *dev = ctx->dev;
  77        struct s5p_mfc_cmd_args h2r_args;
  78        int ret;
  79
  80        /* Preparing decoding - getting instance number */
  81        mfc_debug(2, "Getting instance number (codec: %d)\n", ctx->codec_mode);
  82        dev->curr_ctx = ctx->num;
  83        memset(&h2r_args, 0, sizeof(struct s5p_mfc_cmd_args));
  84        switch (ctx->codec_mode) {
  85        case S5P_MFC_CODEC_H264_DEC:
  86                h2r_args.arg[0] = S5P_FIMV_CODEC_H264_DEC;
  87                break;
  88        case S5P_MFC_CODEC_VC1_DEC:
  89                h2r_args.arg[0] = S5P_FIMV_CODEC_VC1_DEC;
  90                break;
  91        case S5P_MFC_CODEC_MPEG4_DEC:
  92                h2r_args.arg[0] = S5P_FIMV_CODEC_MPEG4_DEC;
  93                break;
  94        case S5P_MFC_CODEC_MPEG2_DEC:
  95                h2r_args.arg[0] = S5P_FIMV_CODEC_MPEG2_DEC;
  96                break;
  97        case S5P_MFC_CODEC_H263_DEC:
  98                h2r_args.arg[0] = S5P_FIMV_CODEC_H263_DEC;
  99                break;
 100        case S5P_MFC_CODEC_VC1RCV_DEC:
 101                h2r_args.arg[0] = S5P_FIMV_CODEC_VC1RCV_DEC;
 102                break;
 103        case S5P_MFC_CODEC_H264_ENC:
 104                h2r_args.arg[0] = S5P_FIMV_CODEC_H264_ENC;
 105                break;
 106        case S5P_MFC_CODEC_MPEG4_ENC:
 107                h2r_args.arg[0] = S5P_FIMV_CODEC_MPEG4_ENC;
 108                break;
 109        case S5P_MFC_CODEC_H263_ENC:
 110                h2r_args.arg[0] = S5P_FIMV_CODEC_H263_ENC;
 111                break;
 112        default:
 113                h2r_args.arg[0] = S5P_FIMV_CODEC_NONE;
 114        };
 115        h2r_args.arg[1] = 0; /* no crc & no pixelcache */
 116        h2r_args.arg[2] = ctx->ctx.ofs;
 117        h2r_args.arg[3] = ctx->ctx.size;
 118        ret = s5p_mfc_cmd_host2risc_v5(dev, S5P_FIMV_H2R_CMD_OPEN_INSTANCE,
 119                                                                &h2r_args);
 120        if (ret) {
 121                mfc_err("Failed to create a new instance\n");
 122                ctx->state = MFCINST_ERROR;
 123        }
 124        return ret;
 125}
 126
 127static int s5p_mfc_close_inst_cmd_v5(struct s5p_mfc_ctx *ctx)
 128{
 129        struct s5p_mfc_dev *dev = ctx->dev;
 130        struct s5p_mfc_cmd_args h2r_args;
 131        int ret;
 132
 133        if (ctx->state == MFCINST_FREE) {
 134                mfc_err("Instance already returned\n");
 135                ctx->state = MFCINST_ERROR;
 136                return -EINVAL;
 137        }
 138        /* Closing decoding instance  */
 139        mfc_debug(2, "Returning instance number %d\n", ctx->inst_no);
 140        dev->curr_ctx = ctx->num;
 141        memset(&h2r_args, 0, sizeof(struct s5p_mfc_cmd_args));
 142        h2r_args.arg[0] = ctx->inst_no;
 143        ret = s5p_mfc_cmd_host2risc_v5(dev, S5P_FIMV_H2R_CMD_CLOSE_INSTANCE,
 144                                                                &h2r_args);
 145        if (ret) {
 146                mfc_err("Failed to return an instance\n");
 147                ctx->state = MFCINST_ERROR;
 148                return -EINVAL;
 149        }
 150        return 0;
 151}
 152
 153/* Initialize cmd function pointers for MFC v5 */
 154static struct s5p_mfc_hw_cmds s5p_mfc_cmds_v5 = {
 155        .cmd_host2risc = s5p_mfc_cmd_host2risc_v5,
 156        .sys_init_cmd = s5p_mfc_sys_init_cmd_v5,
 157        .sleep_cmd = s5p_mfc_sleep_cmd_v5,
 158        .wakeup_cmd = s5p_mfc_wakeup_cmd_v5,
 159        .open_inst_cmd = s5p_mfc_open_inst_cmd_v5,
 160        .close_inst_cmd = s5p_mfc_close_inst_cmd_v5,
 161};
 162
 163struct s5p_mfc_hw_cmds *s5p_mfc_init_hw_cmds_v5(void)
 164{
 165        return &s5p_mfc_cmds_v5;
 166}
 167