spmi_common.c 5.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168
  1. /* Copyright Statement:
  2. *
  3. * This software/firmware and related documentation ("MediaTek Software") are
  4. * protected under relevant copyright laws. The information contained herein is
  5. * confidential and proprietary to MediaTek Inc. and/or its licensors. Without
  6. * the prior written permission of MediaTek inc. and/or its licensors, any
  7. * reproduction, modification, use or disclosure of MediaTek Software, and
  8. * information contained herein, in whole or in part, shall be strictly
  9. * prohibited.
  10. *
  11. * MediaTek Inc. (C) 2019. All rights reserved.
  12. *
  13. * BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
  14. * THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
  15. * RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER
  16. * ON AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL
  17. * WARRANTIES, EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED
  18. * WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR
  19. * NONINFRINGEMENT. NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH
  20. * RESPECT TO THE SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY,
  21. * INCORPORATED IN, OR SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES
  22. * TO LOOK ONLY TO SUCH THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO.
  23. * RECEIVER EXPRESSLY ACKNOWLEDGES THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO
  24. * OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES CONTAINED IN MEDIATEK
  25. * SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK SOFTWARE
  26. * RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
  27. * STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S
  28. * ENTIRE AND CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE
  29. * RELEASED HEREUNDER WILL BE, AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE
  30. * MEDIATEK SOFTWARE AT ISSUE, OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE
  31. * CHARGE PAID BY RECEIVER TO MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
  32. *
  33. * The following software/firmware and/or related documentation ("MediaTek
  34. * Software") have been modified by MediaTek Inc. All revisions are subject to
  35. * any receiver's applicable license agreements with MediaTek Inc.
  36. */
  37. /*
  38. * MTK SPMI Common Driver
  39. *
  40. * Copyright 2018 MediaTek Co.,Ltd.
  41. *
  42. * DESCRIPTION:
  43. * This file provides API for other drivers to access PMIC registers
  44. *
  45. */
  46. #include <pmif.h>
  47. #include <spmi.h>
  48. #include <pmif_sw.h>
  49. #include <spmi_sw.h>
  50. #if SPMI_NO_PMIC
  51. int spmi_ext_register_readl(struct spmi_device *dev, unsigned int addr,
  52. unsigned char *buf, unsigned short len)
  53. {
  54. SPMI_INFO("%s do Nothing.\n", __func__);
  55. return 0;
  56. }
  57. int spmi_ext_register_writel(struct spmi_device *dev, unsigned int addr,
  58. const unsigned char *buf, unsigned short len)
  59. {
  60. SPMI_INFO("%s do Nothing.\n", __func__);
  61. return 0;
  62. }
  63. int spmi_ext_register_readl_field(struct spmi_device *dev, unsigned int addr,
  64. unsigned char *buf, unsigned short len,
  65. unsigned short mask, unsigned short shift)
  66. {
  67. SPMI_INFO("%s do Nothing.\n", __func__);
  68. return 0;
  69. }
  70. int spmi_ext_register_writel_field(struct spmi_device *dev, unsigned int addr,
  71. const unsigned char *buf, unsigned short len,
  72. unsigned short mask, unsigned short shift)
  73. {
  74. SPMI_INFO("%s do Nothing.\n", __func__);
  75. return 0;
  76. }
  77. #else /* #ifdef SPMI_NO_PMIC */
  78. int spmi_register_zero_write(struct spmi_device *dev, unsigned int addr,
  79. unsigned char data)
  80. {
  81. return dev->pmif_arb->write_cmd(dev->pmif_arb, SPMI_CMD_ZERO_WRITE,
  82. dev->slvid, addr, &data, 1);
  83. }
  84. int spmi_register_read(struct spmi_device *dev, unsigned int addr,
  85. unsigned char *buf)
  86. {
  87. return dev->pmif_arb->read_cmd(dev->pmif_arb, SPMI_CMD_READ,
  88. dev->slvid, addr, buf, 1);
  89. }
  90. int spmi_register_write(struct spmi_device *dev, unsigned int addr,
  91. unsigned char data)
  92. {
  93. return dev->pmif_arb->write_cmd(dev->pmif_arb, SPMI_CMD_WRITE,
  94. dev->slvid, addr, &data, 1);
  95. }
  96. int spmi_ext_register_read(struct spmi_device *dev, unsigned int addr,
  97. unsigned char *buf, unsigned short len)
  98. {
  99. return dev->pmif_arb->read_cmd(dev->pmif_arb, SPMI_CMD_EXT_READ,
  100. dev->slvid, addr, buf, len);
  101. }
  102. int spmi_ext_register_write(struct spmi_device *dev, unsigned int addr,
  103. const unsigned char *buf, unsigned short len)
  104. {
  105. return dev->pmif_arb->write_cmd(dev->pmif_arb, SPMI_CMD_EXT_WRITE,
  106. dev->slvid, addr, buf, len);
  107. }
  108. int spmi_ext_register_readl(struct spmi_device *dev, unsigned int addr,
  109. unsigned char *buf, unsigned short len)
  110. {
  111. return dev->pmif_arb->read_cmd(dev->pmif_arb, SPMI_CMD_EXT_READL,
  112. dev->slvid, addr, buf, len);
  113. }
  114. int spmi_ext_register_writel(struct spmi_device *dev, unsigned int addr,
  115. const unsigned char *buf, unsigned short len)
  116. {
  117. return dev->pmif_arb->write_cmd(dev->pmif_arb, SPMI_CMD_EXT_WRITEL,
  118. dev->slvid, addr, buf, len);
  119. }
  120. int spmi_ext_register_readl_field(struct spmi_device *dev, unsigned int addr,
  121. unsigned char *buf, unsigned short len,
  122. unsigned short mask, unsigned short shift)
  123. {
  124. unsigned int ret = 0;
  125. unsigned char rdata = 0;
  126. if (len > 1)
  127. return -2;
  128. ret = dev->pmif_arb->read_cmd(dev->pmif_arb, SPMI_CMD_EXT_READL,
  129. dev->slvid, addr, &rdata, len);
  130. if (ret != 0)
  131. return ret;
  132. *buf = (rdata >> shift) & mask;
  133. return 0;
  134. }
  135. int spmi_ext_register_writel_field(struct spmi_device *dev, unsigned int addr,
  136. const unsigned char *buf, unsigned short len,
  137. unsigned short mask, unsigned short shift)
  138. {
  139. unsigned char data = 0x0;
  140. unsigned int ret = 0;
  141. if (len > 1)
  142. return -2;
  143. ret = spmi_ext_register_readl(dev, addr, &data, 1);
  144. if (ret != 0)
  145. return ret;
  146. data = data & ~(mask << shift);
  147. data |= (*buf << shift);
  148. return dev->pmif_arb->write_cmd(dev->pmif_arb, SPMI_CMD_EXT_WRITEL,
  149. dev->slvid, addr, &data, len);
  150. }
  151. #endif /* endif SPMI_NO_PMIC */