/* Copyright Statement: * * This software/firmware and related documentation ("MediaTek Software") are * protected under relevant copyright laws. The information contained herein * is confidential and proprietary to MediaTek Inc. and/or its licensors. * Without the prior written permission of MediaTek inc. and/or its licensors, * any reproduction, modification, use or disclosure of MediaTek Software, * and information contained herein, in whole or in part, shall be strictly prohibited. */ /* MediaTek Inc. (C) 2015. All rights reserved. * * BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES * THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE") * RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER ON * AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES, * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT. * NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE * SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR * SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES TO LOOK ONLY TO SUCH * THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO. RECEIVER EXPRESSLY ACKNOWLEDGES * THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES * CONTAINED IN MEDIATEK SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK * SOFTWARE RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR * STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND * CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE, * AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE, * OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY RECEIVER TO * MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE. */ #include #include #include #include #include #include #include #include static struct mt_i2c_t i2c = { .id = I2C5, .addr = 0x34, .mode = HS_MODE, .speed = 3400, .pushpull = true, }; struct mt6370_bled_config_t { u8 addr; u8 val; }; static struct mt6370_bled_config_t mt6370_bled_settings[8] = { {.addr = 0xA1, .val = 0x89}, {.addr = 0xA2, .val = 0x04}, {.addr = 0xA3, .val = 0x00}, {.addr = 0xA4, .val = 0x00}, {.addr = 0xA5, .val = 0x00}, {.addr = 0xA6, .val = 0x00}, {.addr = 0xA7, .val = 0x00}, {.addr = 0xA0, .val = 0x42} }; // 6370 default pwm setting, used when dts not found static struct mt6370_bled_config_t mt6370_bled_settings_default_pwm[8] = { {.addr = 0xA1, .val = 0xed}, {.addr = 0xA2, .val = 0xb4}, {.addr = 0xA3, .val = 0x30}, {.addr = 0xA4, .val = 0x07}, {.addr = 0xA5, .val = 0x3f}, {.addr = 0xA6, .val = 0x00}, {.addr = 0xA7, .val = 0x08}, {.addr = 0xA0, .val = 0x7e} }; /* ========================= */ /* I2C operations */ /* ========================= */ static int mt6370_i2c_write_byte(struct mt_i2c_t *i2c, u8 cmd, u8 data) { unsigned int ret = I2C_OK; unsigned char write_buf[2] = {cmd, data}; ret = i2c_write(i2c, write_buf, 2); if (ret != I2C_OK) dprintf(CRITICAL, "%s: I2CW[0x%02X] = 0x%02X failed, code = %d\n", __func__, cmd, data, ret); else dprintf(INFO, "%s: I2CW[0x%02X] = 0x%02X\n", __func__, cmd, data); return ret; } static int mt6370_i2c_read_byte(struct mt_i2c_t *i2c, u8 cmd, u8 *data) { int ret = I2C_OK; u8 ret_data = cmd; ret = i2c_write_read(i2c, &ret_data, 1, 1); if (ret != I2C_OK) dprintf(CRITICAL, "%s: I2CR[0x%02X] failed, code = %d\n", __func__, cmd, ret); else { dprintf(INFO, "%s: I2CR[0x%02X] = 0x%02X\n", __func__, cmd, ret_data); *data = ret_data; } return ret; } static int mt6370_i2c_update_bits(struct mt_i2c_t *i2c, u8 cmd, u8 mask, u8 data) { int ret = 0; u8 reg_data = 0; ret = mt6370_i2c_read_byte(i2c, cmd, ®_data); if (ret != I2C_OK) return ret; reg_data = reg_data & 0xFF; reg_data &= ~mask; reg_data |= (data & mask); return mt6370_i2c_write_byte(i2c, cmd, reg_data); } int mt6370_set_pwm_mode(void) { return mt6370_i2c_update_bits(&i2c, 0xA2, 0x80, 0x80); } static int mt6370_bled_init_setting(void) { int ret = 0; unsigned int i; for (i = 0; i < sizeof(mt6370_bled_settings) / sizeof(struct mt6370_bled_config_t); i++) { ret = mt6370_i2c_write_byte(&i2c, mt6370_bled_settings[i].addr, mt6370_bled_settings[i].val); if (ret < 0) return ret; } return ret; } /** * If the property is not found or the value is not set, * return default value 0. */ unsigned int mt6370_bled_fdt_getprop_u32(const void *fdt, int nodeoffset, const char *name) { const void *data = NULL; int len = 0; data = fdt_getprop(fdt, nodeoffset, name, &len); if (len > 0 && data) return fdt32_to_cpu(*(unsigned int *)data); else return 0; } static unsigned int mt6370_bled_fdt_getprop_bool(const void *fdt, int nodeoffset, const char *name) { const void *data = NULL; int len = 0; data = fdt_getprop(fdt, nodeoffset, name, &len); if (data) return true; else return false; } #define MT6370_BLED_EN (0x40) #define MT6370_BLED_EXTEN (0x80) #define MT6370_BLED_CHANENSHFT 2 #define MT6370_BLED_MAPLINEAR (0x02) #define MT6370_BLED_OVPSHFT (5) #define MT6370_BLED_OCPSHFT (1) #define MT6370_BLED_PWMSHIFT (7) #define MT6370_BLED_PWMDSHFT (5) #define MT6370_BLED_PWMFSHFT (3) #define MT6370_BLFLRAMP_SHFT (3) #define MT6370_BLED_RAMPTSHFT (4) static void mt6370_bled_parsing_dts(void *fdt) { int offset, sub_offset; uint32_t val; #if defined(USE_DTB_NO_DWS) void *lk_drv_fdt = get_lk_overlayed_dtb(); if (lk_drv_fdt == NULL) panic("lk driver fdt is NULL!\n"); offset = fdt_path_offset(lk_drv_fdt, "/mt6370_pmu_dts"); if (offset < 0) goto out; sub_offset = fdt_subnode_offset(lk_drv_fdt, offset, "bled"); if (offset >= 0 && sub_offset >= 0) { val = mt6370_bled_fdt_getprop_bool(lk_drv_fdt, sub_offset, "mt,ext_en_pin"); dprintf(INFO, "[LEDS] mt,ext_en_pin val = %d\n", val); if (val) { mt6370_bled_settings[7].val &= ~(MT6370_BLED_EN | MT6370_BLED_EXTEN); mt6370_bled_settings[7].val |= MT6370_BLED_EXTEN; } val = mt6370_bled_fdt_getprop_u32(lk_drv_fdt, sub_offset, "mt,chan_en"); dprintf(INFO, "[LEDS] mt,chan_en val = %d\n", val); if (val) mt6370_bled_settings[7].val |= (val << MT6370_BLED_CHANENSHFT); val = mt6370_bled_fdt_getprop_bool(lk_drv_fdt, sub_offset, "mt,map_linear"); dprintf(INFO, "[LEDS] mt,map_linear = %d\n", val); if (!val) mt6370_bled_settings[7].val &= ~(MT6370_BLED_MAPLINEAR); val = mt6370_bled_fdt_getprop_u32(lk_drv_fdt, sub_offset, "mt,bl_ovp_level"); dprintf(INFO, "[LEDS] mt,bl_ovp_level = %d\n", val); if (val) mt6370_bled_settings[0].val |= (val << MT6370_BLED_OVPSHFT); val = mt6370_bled_fdt_getprop_u32(lk_drv_fdt, sub_offset, "mt,bl_ocp_level"); dprintf(INFO, "[LEDS] mt,bl_ocp_level = %d\n", val); if (val) mt6370_bled_settings[0].val |= (val << MT6370_BLED_OCPSHFT); val = mt6370_bled_fdt_getprop_bool(lk_drv_fdt, sub_offset, "mt,use_pwm"); dprintf(INFO, "[LEDS] mt,use_pwm = %d\n", val); if (val) mt6370_bled_settings[1].val |= (val << MT6370_BLED_PWMSHIFT); val = mt6370_bled_fdt_getprop_u32(lk_drv_fdt, sub_offset, "mt,pwm_fsample"); dprintf(INFO, "[LEDS] mt,pwm_fsample = %d\n", val); if (val) mt6370_bled_settings[1].val |= (val << MT6370_BLED_PWMFSHFT); val = mt6370_bled_fdt_getprop_u32(lk_drv_fdt, sub_offset, "mt,pwm_deglitch"); dprintf(INFO, "[LEDS] mt,pwm_deglitch = %d\n", val); if (val) mt6370_bled_settings[1].val |= (val << MT6370_BLED_PWMDSHFT); val = mt6370_bled_fdt_getprop_u32(lk_drv_fdt, sub_offset, "mt,bled_ramptime"); dprintf(INFO, "[LEDS] mt,bled_ramptime = %d\n", val); if (val) mt6370_bled_settings[2].val |= (val << MT6370_BLED_RAMPTSHFT); val = mt6370_bled_fdt_getprop_u32(lk_drv_fdt, sub_offset, "mt,bled_flash_ramp"); dprintf(INFO, "[LEDS] mt,bled_flash_ramp = %d\n", val); if (val) mt6370_bled_settings[6].val |= (val << MT6370_BLFLRAMP_SHFT); val = mt6370_bled_fdt_getprop_u32(lk_drv_fdt, sub_offset, "mt,max_bled_brightness"); dprintf(INFO, "[LEDS] mt,max_bled_brightness = %d\n", val); if (val) { val = ((u64)val * 255) >> 8; mt6370_bled_settings[3].val |= (val & 0x7); mt6370_bled_settings[4].val |= ((val >> 3) & 0xff); } } else out: #endif { memcpy(mt6370_bled_settings, mt6370_bled_settings_default_pwm, sizeof(mt6370_bled_settings)); dprintf(CRITICAL, "[LEDS] cannot read settings from dts, using default setting\n"); } } static int mt6370_init_bled(void) { unsigned int i; int ret = 0; void *lk_drv_fdt = get_lk_overlayed_dtb(); if (lk_drv_fdt == NULL) panic("lk driver fdt is NULL!\n"); dprintf(INFO, "[LEDS]LK: %s\n", __func__); mt6370_bled_parsing_dts(lk_drv_fdt); for (i = 0; i < sizeof(mt6370_bled_settings) / sizeof(struct mt6370_bled_config_t); i++) { ret = mt6370_i2c_write_byte(&i2c, mt6370_bled_settings[i].addr, mt6370_bled_settings[i].val); if (ret < 0) return ret; } return ret; } int mt6370_bled_probe(void) { int ret = 0; ret = mt6370_init_bled(); if (ret < 0) dprintf(CRITICAL, "%s fail, ret = %d\n", __func__, ret); return ret; }