vcmdswhwregisters.c 5.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148
  1. /*
  2. * Hantro Decoder device driver (kernel module)
  3. *
  4. * Copyright (C) 2020 VeriSilicon Microelectronics Co., Ltd.
  5. *
  6. * This program is free software; you can redistribute it and/or
  7. * modify it under the terms of the GNU General Public License
  8. * as published by the Free Software Foundation; either version 2
  9. * of the License, or (at your option) any later version.
  10. * This program is distributed in the hope that it will be useful,
  11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. * GNU General Public License for more details.
  14. *
  15. * You should have received a copy of the GNU General Public License
  16. * along with this program; if not, write to the Free Software
  17. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
  18. *
  19. ------------------------------------------------------------------------------*/
  20. /*------------------------------------------------------------------------------
  21. Table of contents
  22. 1. Include headers
  23. 2. External compiler flags
  24. 3. Module defines
  25. ------------------------------------------------------------------------------*/
  26. /*------------------------------------------------------------------------------
  27. 1. Include headers
  28. ------------------------------------------------------------------------------*/
  29. #include <linux/io.h> /* for ioread32 and iowrite32 ... */
  30. #include "vcmdswhwregisters.h"
  31. /* NOTE: Don't use ',' in descriptions, because it is used as separator in csv
  32. * parsing. */
  33. const regVcmdField_s asicVcmdRegisterDesc[] =
  34. {
  35. #include "vcmdregistertable.h"
  36. };
  37. /*------------------------------------------------------------------------------
  38. 2. External compiler flags
  39. --------------------------------------------------------------------------------
  40. --------------------------------------------------------------------------------
  41. 3. Module defines
  42. ------------------------------------------------------------------------------*/
  43. /* Define this to print debug info for every register write.
  44. #define DEBUG_PRINT_REGS */
  45. /*******************************************************************************
  46. Function name : vcmd_read_reg
  47. Description : Retrive the content of a hadware register
  48. Note: The status register will be read after every MB
  49. so it may be needed to buffer it's content if reading
  50. the HW register is slow.
  51. Return type : u32
  52. Argument : u32 offset
  53. *******************************************************************************/
  54. u32 vcmd_read_reg(const void *hwregs, u32 offset)
  55. {
  56. u32 val;
  57. val =(u32) ioread32((void*)hwregs + offset);
  58. PDEBUG("vcmd_read_reg 0x%02x --> %08x\n", offset, val);
  59. return val;
  60. }
  61. /*******************************************************************************
  62. Function name : vcmd_write_reg
  63. Description : Set the content of a hadware register
  64. Return type : void
  65. Argument : u32 offset
  66. Argument : u32 val
  67. *******************************************************************************/
  68. void vcmd_write_reg(const void *hwregs, u32 offset, u32 val)
  69. {
  70. iowrite32(val,(void*)hwregs + offset);
  71. PDEBUG("vcmd_write_reg 0x%02x with value %08x\n", offset, val);
  72. }
  73. /*------------------------------------------------------------------------------
  74. vcmd_write_register_value
  75. Write a value into a defined register field (write will happens actually).
  76. ------------------------------------------------------------------------------*/
  77. void vcmd_write_register_value(const void *hwregs,u32* reg_mirror,regVcmdName name, u32 value)
  78. {
  79. const regVcmdField_s *field;
  80. u32 regVal;
  81. field = &asicVcmdRegisterDesc[name];
  82. #ifdef DEBUG_PRINT_REGS
  83. PDEBUG("vcmd_write_register_value 0x%2x 0x%08x Value: %10d %s\n",
  84. field->base, field->mask, value, field->description);
  85. #endif
  86. /* Check that value fits in field */
  87. PDEBUG("field->name == name=%d\n",field->name == name);
  88. PDEBUG("((field->mask >> field->lsb) << field->lsb) == field->mask=%d\n",((field->mask >> field->lsb) << field->lsb) == field->mask);
  89. PDEBUG("(field->mask >> field->lsb) >= value=%d\n",(field->mask >> field->lsb) >= value);
  90. PDEBUG("field->base < ASIC_VCMD_SWREG_AMOUNT*4=%d\n",field->base < ASIC_VCMD_SWREG_AMOUNT*4);
  91. /* Clear previous value of field in register */
  92. regVal = reg_mirror[field->base/4] & ~(field->mask);
  93. /* Put new value of field in register */
  94. reg_mirror[field->base/4] = regVal | ((value << field->lsb) & field->mask);
  95. /* write it into HW registers */
  96. vcmd_write_reg(hwregs, field->base,reg_mirror[field->base/4]);
  97. }
  98. /*------------------------------------------------------------------------------
  99. vcmd_get_register_value
  100. Get an unsigned value from the ASIC registers
  101. ------------------------------------------------------------------------------*/
  102. u32 vcmd_get_register_value(const void *hwregs, u32* reg_mirror,regVcmdName name)
  103. {
  104. const regVcmdField_s *field;
  105. u32 value;
  106. field = &asicVcmdRegisterDesc[name];
  107. PDEBUG("field->base < ASIC_VCMD_SWREG_AMOUNT * 4=%d\n",field->base < ASIC_VCMD_SWREG_AMOUNT * 4);
  108. value = reg_mirror[field->base / 4] = vcmd_read_reg(hwregs, field->base);
  109. value = (value & field->mask) >> field->lsb;
  110. return value;
  111. }