Quelle  vce_v1_0.c   Sprache: C

/*
 * Copyright 2013 Advanced Micro Devices, Inc.
 * All Rights Reserved.
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the
 * "Software"), to deal in the Software without restriction, including
 * without limitation the rights to use, copy, modify, merge, publish,
 * distribute, sub license, and/or sell copies of the Software, and to
 * permit persons to whom the Software is furnished to do so, subject to
 * the following conditions:
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
 * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
 * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
 * USE OR OTHER DEALINGS IN THE SOFTWARE.
 *
 * The above copyright notice and this permission notice (including the
 * next paragraph) shall be included in all copies or substantial portions
 * of the Software.
 *
 * Authors: Christian König <christian.koenig@amd.com>
 */

#include <linux/firmware.h>

#include "radeon.h"
#include "radeon_asic.h"
#include "sid.h"
#include "vce.h"

#define VCE_V1_0_FW_SIZE (256 * 1024)
#define VCE_V1_0_STACK_SIZE (64 * 1024)
#define VCE_V1_0_DATA_SIZE (7808 * (RADEON_MAX_VCE_HANDLES + 1))

struct vce_v1_0_fw_signature
{
 int32_t off;
 uint32_t len;
 int32_t num;
 struct {
  uint32_t chip_id;
  uint32_t keyselect;
  uint32_t nonce[4];
  uint32_t sigval[4];
 } val[8];
};

/**
 * vce_v1_0_get_rptr - get read pointer
 *
 * @rdev: radeon_device pointer
 * @ring: radeon_ring pointer
 *
 * Returns the current hardware read pointer
 */
uint32_t vce_v1_0_get_rptr(struct radeon_device *rdev,
      struct radeon_ring *ring)
{
 if (ring->idx == TN_RING_TYPE_VCE1_INDEX)
  return RREG32(VCE_RB_RPTR);
 else
  return RREG32(VCE_RB_RPTR2);
}

/**
 * vce_v1_0_get_wptr - get write pointer
 *
 * @rdev: radeon_device pointer
 * @ring: radeon_ring pointer
 *
 * Returns the current hardware write pointer
 */
uint32_t vce_v1_0_get_wptr(struct radeon_device *rdev,
      struct radeon_ring *ring)
{
 if (ring->idx == TN_RING_TYPE_VCE1_INDEX)
  return RREG32(VCE_RB_WPTR);
 else
  return RREG32(VCE_RB_WPTR2);
}

/**
 * vce_v1_0_set_wptr - set write pointer
 *
 * @rdev: radeon_device pointer
 * @ring: radeon_ring pointer
 *
 * Commits the write pointer to the hardware
 */
void vce_v1_0_set_wptr(struct radeon_device *rdev,
         struct radeon_ring *ring)
{
 if (ring->idx == TN_RING_TYPE_VCE1_INDEX)
  WREG32(VCE_RB_WPTR, ring->wptr);
 else
  WREG32(VCE_RB_WPTR2, ring->wptr);
}

void vce_v1_0_enable_mgcg(struct radeon_device *rdev, bool enable)
{
 u32 tmp;

 if (enable && (rdev->cg_flags & RADEON_CG_SUPPORT_VCE_MGCG)) {
  tmp = RREG32(VCE_CLOCK_GATING_A);
  tmp |= CGC_DYN_CLOCK_MODE;
  WREG32(VCE_CLOCK_GATING_A, tmp);

  tmp = RREG32(VCE_UENC_CLOCK_GATING);
  tmp &= ~0x1ff000;
  tmp |= 0xff800000;
  WREG32(VCE_UENC_CLOCK_GATING, tmp);

  tmp = RREG32(VCE_UENC_REG_CLOCK_GATING);
  tmp &= ~0x3ff;
  WREG32(VCE_UENC_REG_CLOCK_GATING, tmp);
 } else {
  tmp = RREG32(VCE_CLOCK_GATING_A);
  tmp &= ~CGC_DYN_CLOCK_MODE;
  WREG32(VCE_CLOCK_GATING_A, tmp);

  tmp = RREG32(VCE_UENC_CLOCK_GATING);
  tmp |= 0x1ff000;
  tmp &= ~0xff800000;
  WREG32(VCE_UENC_CLOCK_GATING, tmp);

  tmp = RREG32(VCE_UENC_REG_CLOCK_GATING);
  tmp |= 0x3ff;
  WREG32(VCE_UENC_REG_CLOCK_GATING, tmp);
 }
}

static void vce_v1_0_init_cg(struct radeon_device *rdev)
{
 u32 tmp;

 tmp = RREG32(VCE_CLOCK_GATING_A);
 tmp |= CGC_DYN_CLOCK_MODE;
 WREG32(VCE_CLOCK_GATING_A, tmp);

 tmp = RREG32(VCE_CLOCK_GATING_B);
 tmp |= 0x1e;
 tmp &= ~0xe100e1;
 WREG32(VCE_CLOCK_GATING_B, tmp);

 tmp = RREG32(VCE_UENC_CLOCK_GATING);
 tmp &= ~0xff9ff000;
 WREG32(VCE_UENC_CLOCK_GATING, tmp);

 tmp = RREG32(VCE_UENC_REG_CLOCK_GATING);
 tmp &= ~0x3ff;
 WREG32(VCE_UENC_REG_CLOCK_GATING, tmp);
}

int vce_v1_0_load_fw(struct radeon_device *rdev, uint32_t *data)
{
 struct vce_v1_0_fw_signature *sign = (void*)rdev->vce_fw->data;
 uint32_t chip_id;
 int i;

 switch (rdev->family) {
 case CHIP_TAHITI:
  chip_id = 0x01000014;
  break;
 case CHIP_VERDE:
  chip_id = 0x01000015;
  break;
 case CHIP_PITCAIRN:
  chip_id = 0x01000016;
  break;
 case CHIP_ARUBA:
  chip_id = 0x01000017;
  break;
 default:
  return -EINVAL;
 }

 for (i = 0; i < le32_to_cpu(sign->num); ++i) {
  if (le32_to_cpu(sign->val[i].chip_id) == chip_id)
   break;
 }

 if (i == le32_to_cpu(sign->num))
  return -EINVAL;

 data += (256 - 64) / 4;
 data[0] = sign->val[i].nonce[0];
 data[1] = sign->val[i].nonce[1];
 data[2] = sign->val[i].nonce[2];
 data[3] = sign->val[i].nonce[3];
 data[4] = cpu_to_le32(le32_to_cpu(sign->len) + 64);

 memset(&data[5], 0, 44);
 memcpy(&data[16], &sign[1], rdev->vce_fw->size - sizeof(*sign));

 data += (le32_to_cpu(sign->len) + 64) / 4;
 data[0] = sign->val[i].sigval[0];
 data[1] = sign->val[i].sigval[1];
 data[2] = sign->val[i].sigval[2];
 data[3] = sign->val[i].sigval[3];

 rdev->vce.keyselect = le32_to_cpu(sign->val[i].keyselect);

 return 0;
}

unsigned vce_v1_0_bo_size(struct radeon_device *rdev)
{
 WARN_ON(VCE_V1_0_FW_SIZE < rdev->vce_fw->size);
 return VCE_V1_0_FW_SIZE + VCE_V1_0_STACK_SIZE + VCE_V1_0_DATA_SIZE;
}

int vce_v1_0_resume(struct radeon_device *rdev)
{
 uint64_t addr = rdev->vce.gpu_addr;
 uint32_t size;
 int i;

 WREG32_P(VCE_CLOCK_GATING_A, 0, ~(1 << 16));
 WREG32_P(VCE_UENC_CLOCK_GATING, 0x1FF000, ~0xFF9FF000);
 WREG32_P(VCE_UENC_REG_CLOCK_GATING, 0x3F, ~0x3F);
 WREG32(VCE_CLOCK_GATING_B, 0);

 WREG32_P(VCE_LMI_FW_PERIODIC_CTRL, 0x4, ~0x4);

 WREG32(VCE_LMI_CTRL, 0x00398000);
 WREG32_P(VCE_LMI_CACHE_CTRL, 0x0, ~0x1);
 WREG32(VCE_LMI_SWAP_CNTL, 0);
 WREG32(VCE_LMI_SWAP_CNTL1, 0);
 WREG32(VCE_LMI_VM_CTRL, 0);

 WREG32(VCE_VCPU_SCRATCH7, RADEON_MAX_VCE_HANDLES);

 addr += 256;
 size = VCE_V1_0_FW_SIZE;
 WREG32(VCE_VCPU_CACHE_OFFSET0, addr & 0x7fffffff);
 WREG32(VCE_VCPU_CACHE_SIZE0, size);

 addr += size;
 size = VCE_V1_0_STACK_SIZE;
 WREG32(VCE_VCPU_CACHE_OFFSET1, addr & 0x7fffffff);
 WREG32(VCE_VCPU_CACHE_SIZE1, size);

 addr += size;
 size = VCE_V1_0_DATA_SIZE;
 WREG32(VCE_VCPU_CACHE_OFFSET2, addr & 0x7fffffff);
 WREG32(VCE_VCPU_CACHE_SIZE2, size);

 WREG32_P(VCE_LMI_CTRL2, 0x0, ~0x100);

 WREG32(VCE_LMI_FW_START_KEYSEL, rdev->vce.keyselect);

 for (i = 0; i < 10; ++i) {
  mdelay(10);
  if (RREG32(VCE_FW_REG_STATUS) & VCE_FW_REG_STATUS_DONE)
   break;
 }

 if (i == 10)
  return -ETIMEDOUT;

 if (!(RREG32(VCE_FW_REG_STATUS) & VCE_FW_REG_STATUS_PASS))
  return -EINVAL;

 for (i = 0; i < 10; ++i) {
  mdelay(10);
  if (!(RREG32(VCE_FW_REG_STATUS) & VCE_FW_REG_STATUS_BUSY))
   break;
 }

 if (i == 10)
  return -ETIMEDOUT;

 vce_v1_0_init_cg(rdev);

 return 0;
}

/**
 * vce_v1_0_start - start VCE block
 *
 * @rdev: radeon_device pointer
 *
 * Setup and start the VCE block
 */
int vce_v1_0_start(struct radeon_device *rdev)
{
 struct radeon_ring *ring;
 int i, j, r;

 /* set BUSY flag */
 WREG32_P(VCE_STATUS, 1, ~1);

 ring = &rdev->ring[TN_RING_TYPE_VCE1_INDEX];
 WREG32(VCE_RB_RPTR, ring->wptr);
 WREG32(VCE_RB_WPTR, ring->wptr);
 WREG32(VCE_RB_BASE_LO, ring->gpu_addr);
 WREG32(VCE_RB_BASE_HI, upper_32_bits(ring->gpu_addr));
 WREG32(VCE_RB_SIZE, ring->ring_size / 4);

 ring = &rdev->ring[TN_RING_TYPE_VCE2_INDEX];
 WREG32(VCE_RB_RPTR2, ring->wptr);
 WREG32(VCE_RB_WPTR2, ring->wptr);
 WREG32(VCE_RB_BASE_LO2, ring->gpu_addr);
 WREG32(VCE_RB_BASE_HI2, upper_32_bits(ring->gpu_addr));
 WREG32(VCE_RB_SIZE2, ring->ring_size / 4);

 WREG32_P(VCE_VCPU_CNTL, VCE_CLK_EN, ~VCE_CLK_EN);

 WREG32_P(VCE_SOFT_RESET,
   VCE_ECPU_SOFT_RESET |
   VCE_FME_SOFT_RESET, ~(
   VCE_ECPU_SOFT_RESET |
   VCE_FME_SOFT_RESET));

 mdelay(100);

 WREG32_P(VCE_SOFT_RESET, 0, ~(
   VCE_ECPU_SOFT_RESET |
   VCE_FME_SOFT_RESET));

 for (i = 0; i < 10; ++i) {
  uint32_t status;
  for (j = 0; j < 100; ++j) {
   status = RREG32(VCE_STATUS);
   if (status & 2)
    break;
   mdelay(10);
  }
  r = 0;
  if (status & 2)
   break;

  DRM_ERROR("VCE not responding, trying to reset the ECPU!!!\n");
  WREG32_P(VCE_SOFT_RESET, VCE_ECPU_SOFT_RESET, ~VCE_ECPU_SOFT_RESET);
  mdelay(10);
  WREG32_P(VCE_SOFT_RESET, 0, ~VCE_ECPU_SOFT_RESET);
  mdelay(10);
  r = -1;
 }

 /* clear BUSY flag */
 WREG32_P(VCE_STATUS, 0, ~1);

 if (r) {
  DRM_ERROR("VCE not responding, giving up!!!\n");
  return r;
 }

 return 0;
}

int vce_v1_0_init(struct radeon_device *rdev)
{
 struct radeon_ring *ring;
 int r;

 r = vce_v1_0_start(rdev);
 if (r)
  return r;

 ring = &rdev->ring[TN_RING_TYPE_VCE1_INDEX];
 ring->ready = true;
 r = radeon_ring_test(rdev, TN_RING_TYPE_VCE1_INDEX, ring);
 if (r) {
  ring->ready = false;
  return r;
 }

 ring = &rdev->ring[TN_RING_TYPE_VCE2_INDEX];
 ring->ready = true;
 r = radeon_ring_test(rdev, TN_RING_TYPE_VCE2_INDEX, ring);
 if (r) {
  ring->ready = false;
  return r;
 }

 DRM_INFO("VCE initialized successfully.\n");

 return 0;
}