mt6370_pmu_bled.c 8.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256
  1. /* Copyright Statement:
  2. *
  3. * This software/firmware and related documentation ("MediaTek Software") are
  4. * protected under relevant copyright laws. The information contained herein
  5. * is confidential and proprietary to MediaTek Inc. and/or its licensors.
  6. * Without the prior written permission of MediaTek inc. and/or its licensors,
  7. * any reproduction, modification, use or disclosure of MediaTek Software,
  8. * and information contained herein, in whole or in part, shall be strictly prohibited.
  9. */
  10. /* MediaTek Inc. (C) 2015. All rights reserved.
  11. *
  12. * BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
  13. * THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
  14. * RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER ON
  15. * AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES,
  16. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF
  17. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT.
  18. * NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE
  19. * SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR
  20. * SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES TO LOOK ONLY TO SUCH
  21. * THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO. RECEIVER EXPRESSLY ACKNOWLEDGES
  22. * THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES
  23. * CONTAINED IN MEDIATEK SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK
  24. * SOFTWARE RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
  25. * STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND
  26. * CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE,
  27. * AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE,
  28. * OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY RECEIVER TO
  29. * MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
  30. */
  31. #include <platform/mt_typedefs.h>
  32. #include <platform/mt_i2c.h>
  33. #include <platform/errno.h>
  34. #include <libfdt.h>
  35. #include <printf.h>
  36. #include <string.h>
  37. #include <lk_builtin_dtb.h>
  38. #include "mt6370_pmu_bled.h"
  39. #include "mtk_charger.h"
  40. #define MT6370_PMU_BLED_LK_DRV_VERSION "1.0.3_MTK"
  41. static struct mt_i2c_t i2c = {
  42. .id = I2C5,
  43. .addr = MT6370_SLAVE_ADDR,
  44. .mode = FS_MODE,
  45. .speed = 400,
  46. .pushpull = false,
  47. };
  48. struct mt6370_bled_config_t {
  49. u8 addr;
  50. u8 val;
  51. };
  52. static struct mt6370_bled_config_t mt6370_bled_settings[] = {
  53. {.addr = 0xA1, .val = 0x89},
  54. {.addr = 0xA2, .val = 0x04},
  55. {.addr = 0xA3, .val = 0x00},
  56. {.addr = 0xA4, .val = 0x00},
  57. {.addr = 0xA5, .val = 0x00},
  58. {.addr = 0xA6, .val = 0x00},
  59. {.addr = 0xA7, .val = 0x00},
  60. {.addr = 0xA0, .val = 0x42},
  61. {.addr = 0xAD, .val = 0x00},
  62. };
  63. /* 6370 default pwm setting, used when dts not found */
  64. static struct mt6370_bled_config_t mt6370_bled_settings_default_pwm[] = {
  65. {.addr = 0xA1, .val = 0xED},
  66. {.addr = 0xA2, .val = 0xB4},
  67. {.addr = 0xA3, .val = 0x30},
  68. {.addr = 0xA4, .val = 0x07},
  69. {.addr = 0xA5, .val = 0x3F},
  70. {.addr = 0xA6, .val = 0x00},
  71. {.addr = 0xA7, .val = 0x08},
  72. {.addr = 0xA0, .val = 0x7E},
  73. {.addr = 0xAD, .val = 0x00},
  74. };
  75. /* ========================= */
  76. /* I2C operations */
  77. /* ========================= */
  78. static int mt6370_i2c_read_byte(struct mt_i2c_t *i2c, u8 cmd, u8 *data)
  79. {
  80. int ret = 0;
  81. u8 reg_data = cmd;
  82. ret = i2c_write_read(i2c, &reg_data, 1, 1);
  83. if (ret != I2C_OK)
  84. dprintf(CRITICAL, "%s: I2CR[0x%02X] fail(%d)\n",
  85. __func__, cmd, ret);
  86. else {
  87. dprintf(INFO, "%s: I2CR[0x%02X] = 0x%02X\n",
  88. __func__, cmd, reg_data);
  89. *data = reg_data;
  90. }
  91. return ret;
  92. }
  93. static int mt6370_i2c_write_byte(struct mt_i2c_t *i2c, u8 cmd, u8 data)
  94. {
  95. int ret = 0;
  96. u8 write_buf[2] = {cmd, data};
  97. ret = i2c_write(i2c, write_buf, 2);
  98. if (ret != I2C_OK)
  99. dprintf(CRITICAL, "%s: I2CW[0x%02X] = 0x%02X fail(%d)\n",
  100. __func__, cmd, data, ret);
  101. else
  102. dprintf(INFO, "%s: I2CW[0x%02X] = 0x%02X\n",
  103. __func__, cmd, data);
  104. return ret;
  105. }
  106. static void mt6370_bled_parse_dt(void *fdt)
  107. {
  108. int ret = 0, offset = 0, sub_offset = 0;
  109. u32 val = 0;
  110. u8 vendor_id = 0;
  111. offset = fdt_node_offset_by_compatible(fdt, -1, "mediatek,subpmic_pmu");
  112. sub_offset = fdt_parent_offset(fdt, offset);
  113. if (offset >= 0 && sub_offset >= 0) {
  114. val = chr_fdt_getprop_u32(fdt, sub_offset, "id");
  115. if (val) {
  116. i2c.id = val;
  117. dprintf(CRITICAL, "%s: subpmic_pmu id = %d\n",
  118. __func__, i2c.id);
  119. }
  120. }
  121. offset = fdt_path_offset(fdt, "/mt6370_pmu_dts");
  122. sub_offset = fdt_subnode_offset(fdt, offset, "bled");
  123. if (offset >= 0 && sub_offset >= 0) {
  124. val = chr_fdt_getprop_bool(fdt, sub_offset, "mt,ext_en_pin");
  125. dprintf(INFO, "[LEDS] mt,ext_en_pin val = %d\n", val);
  126. if (val) {
  127. mt6370_bled_settings[7].val &= ~(MT6370_BLED_EN | MT6370_BLED_EXTEN);
  128. mt6370_bled_settings[7].val |= MT6370_BLED_EXTEN;
  129. }
  130. val = chr_fdt_getprop_u32(fdt, sub_offset, "mt,chan_en");
  131. dprintf(INFO, "[LEDS] mt,chan_en val = %d\n", val);
  132. if (val)
  133. mt6370_bled_settings[7].val |= (val << MT6370_BLED_CHANENSHFT);
  134. val = chr_fdt_getprop_bool(fdt, sub_offset, "mt,map_linear");
  135. dprintf(INFO, "[LEDS] mt,map_linear = %d\n", val);
  136. if (!val)
  137. mt6370_bled_settings[7].val &= ~(MT6370_BLED_MAPLINEAR);
  138. val = chr_fdt_getprop_u32(fdt, sub_offset, "mt,bl_ovp_level");
  139. dprintf(INFO, "[LEDS] mt,bl_ovp_level = %d\n", val);
  140. if (val)
  141. mt6370_bled_settings[0].val |= (val << MT6370_BLED_OVPSHFT);
  142. val = chr_fdt_getprop_u32(fdt, sub_offset, "mt,bl_ocp_level");
  143. dprintf(INFO, "[LEDS] mt,bl_ocp_level = %d\n", val);
  144. if (val)
  145. mt6370_bled_settings[0].val |= (val << MT6370_BLED_OCPSHFT);
  146. val = chr_fdt_getprop_bool(fdt, sub_offset, "mt,use_pwm");
  147. dprintf(INFO, "[LEDS] mt,use_pwm = %d\n", val);
  148. if (val)
  149. mt6370_bled_settings[1].val |= (val << MT6370_BLED_PWMSHIFT);
  150. val = chr_fdt_getprop_u32(fdt, sub_offset, "mt,pwm_fsample");
  151. dprintf(INFO, "[LEDS] mt,pwm_fsample = %d\n", val);
  152. if (val)
  153. mt6370_bled_settings[1].val |= (val << MT6370_BLED_PWMFSHFT);
  154. val = chr_fdt_getprop_u32(fdt, sub_offset, "mt,pwm_deglitch");
  155. dprintf(INFO, "[LEDS] mt,pwm_deglitch = %d\n", val);
  156. if (val)
  157. mt6370_bled_settings[1].val |= (val << MT6370_BLED_PWMDSHFT);
  158. val = chr_fdt_getprop_u32(fdt, sub_offset, "mt,pwm_hys_en");
  159. dprintf(INFO, "[LEDS] mt,pwm_hys_en = %d\n", val);
  160. if (!val)
  161. mt6370_bled_settings[1].val &= ~(MT6370_BLED_PWMHE);
  162. val = chr_fdt_getprop_u32(fdt, sub_offset, "mt,pwm_hys");
  163. dprintf(INFO, "[LEDS] mt,pwm_hys = %d\n", val);
  164. if (val)
  165. mt6370_bled_settings[1].val |= (val << MT6370_BLED_PWMHSHFT);
  166. val = chr_fdt_getprop_u32(fdt, sub_offset, "mt,bled_ramptime");
  167. dprintf(INFO, "[LEDS] mt,bled_ramptime = %d\n", val);
  168. if (val)
  169. mt6370_bled_settings[2].val |= (val << MT6370_BLED_RAMPTSHFT);
  170. val = chr_fdt_getprop_u32(fdt, sub_offset, "mt,bled_flash_ramp");
  171. dprintf(INFO, "[LEDS] mt,bled_flash_ramp = %d\n", val);
  172. if (val)
  173. mt6370_bled_settings[6].val |= (val << MT6370_BLFLRAMP_SHFT);
  174. val = chr_fdt_getprop_u32(fdt, sub_offset, "mt,max_bled_brightness");
  175. dprintf(INFO, "[LEDS] mt,max_bled_brightness = %d\n", val);
  176. if (val) {
  177. val = ((u64)val * 255) >> 8;
  178. mt6370_bled_settings[3].val |= (val & 0x7);
  179. mt6370_bled_settings[4].val |= ((val >> 3) & 0xFF);
  180. }
  181. val = chr_fdt_getprop_u32(fdt, sub_offset, "mt,bled_curr_scale");
  182. dprintf(INFO, "[LEDS] mt,bled_curr_scale = %d\n", val);
  183. if (val)
  184. mt6370_bled_settings[8].val |= (val << MT6370_BLED_CURR_SCALESHFT);
  185. val = chr_fdt_getprop_u32(fdt, sub_offset, "mt,pwm_lpf_coef");
  186. dprintf(INFO, "[LEDS] mt,pwm_lpf_coef = %d\n", val);
  187. if (val)
  188. mt6370_bled_settings[8].val |= (val << MT6370_PWM_LPF_COEFSHFT);
  189. val = chr_fdt_getprop_bool(fdt, sub_offset, "mt,pwm_lpf_en");
  190. dprintf(INFO, "[LEDS] mt,pwm_lpf_en = %d\n", val);
  191. if (val)
  192. mt6370_bled_settings[8].val |= (val << MT6370_PWM_LPF_ENSHFT);
  193. val = chr_fdt_getprop_bool(fdt, sub_offset, "mt,bled_curr_mode");
  194. dprintf(INFO, "[LEDS] mt,bled_curr_mode = %d\n", val);
  195. if (val)
  196. mt6370_bled_settings[8].val |= (val << MT6370_BLED_CURR_MODESHFT);
  197. } else {
  198. memcpy(mt6370_bled_settings, mt6370_bled_settings_default_pwm, sizeof(mt6370_bled_settings));
  199. dprintf(CRITICAL, "[LEDS] cannot read settings from dts, using default setting\n");
  200. }
  201. ret = mt6370_i2c_read_byte(&i2c, MT6370_PMU_REG_DEVINFO, &vendor_id);
  202. if (ret != I2C_OK)
  203. return;
  204. vendor_id &= 0xF0;
  205. if (vendor_id == MT6372_VENDOR_ID || vendor_id == MT6372C_VENDOR_ID)
  206. mt6370_bled_settings[3].val <<= 3;
  207. }
  208. int mt6370_bled_probe(void)
  209. {
  210. int ret = 0;
  211. u32 i = 0;
  212. dprintf(INFO, "%s: (%s)\n", __func__, MT6370_PMU_BLED_LK_DRV_VERSION);
  213. mt6370_bled_parse_dt(get_lk_overlayed_dtb());
  214. for (i = 0; i < ARRAY_SIZE(mt6370_bled_settings); i++) {
  215. ret = mt6370_i2c_write_byte(&i2c, mt6370_bled_settings[i].addr,
  216. mt6370_bled_settings[i].val);
  217. if (ret != I2C_OK)
  218. break;
  219. }
  220. return ret;
  221. }
  222. /*
  223. * Release Note
  224. * 1.0.3
  225. * (1) Move the driver to the common directory
  226. *
  227. * 1.0.2
  228. * (1) Decrease I2C speed from 3400Hz to 400Hz
  229. *
  230. * 1.0.1
  231. * (1) Add support for MT6372
  232. *
  233. * 1.0.0
  234. * (1) Initial release
  235. */