1 /* 2 * Copyright 2019 Advanced Micro Devices, Inc. 3 * 4 * Permission is hereby granted, free of charge, to any person obtaining a 5 * copy of this software and associated documentation files (the "Software"), 6 * to deal in the Software without restriction, including without limitation 7 * the rights to use, copy, modify, merge, publish, distribute, sublicense, 8 * and/or sell copies of the Software, and to permit persons to whom the 9 * Software is furnished to do so, subject to the following conditions: 10 * 11 * The above copyright notice and this permission notice shall be included in 12 * all copies or substantial portions of the Software. 13 * 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 17 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR 18 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, 19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR 20 * OTHER DEALINGS IN THE SOFTWARE. 21 * 22 * Authors: AMD 23 * 24 */ 25 26 #include "dmub_abm.h" 27 #include "dce_abm.h" 28 #include "dc.h" 29 #include "dc_dmub_srv.h" 30 #include "dmub/dmub_srv.h" 31 #include "core_types.h" 32 #include "dm_services.h" 33 #include "reg_helper.h" 34 #include "fixed31_32.h" 35 36 #include "atom.h" 37 38 #define TO_DMUB_ABM(abm)\ 39 container_of(abm, struct dce_abm, base) 40 41 #define REG(reg) \ 42 (dce_abm->regs->reg) 43 44 #undef FN 45 #define FN(reg_name, field_name) \ 46 dce_abm->abm_shift->field_name, dce_abm->abm_mask->field_name 47 48 #define CTX \ 49 dce_abm->base.ctx 50 51 #define DISABLE_ABM_IMMEDIATELY 255 52 53 54 55 static void dmub_abm_enable_fractional_pwm(struct dc_context *dc) 56 { 57 union dmub_rb_cmd cmd; 58 uint32_t fractional_pwm = (dc->dc->config.disable_fractional_pwm == false) ? 1 : 0; 59 uint32_t edp_id_count = dc->dc_edp_id_count; 60 int i; 61 uint8_t panel_mask = 0; 62 63 for (i = 0; i < edp_id_count; i++) 64 panel_mask |= 0x01 << i; 65 66 memset(&cmd, 0, sizeof(cmd)); 67 cmd.abm_set_pwm_frac.header.type = DMUB_CMD__ABM; 68 cmd.abm_set_pwm_frac.header.sub_type = DMUB_CMD__ABM_SET_PWM_FRAC; 69 cmd.abm_set_pwm_frac.abm_set_pwm_frac_data.fractional_pwm = fractional_pwm; 70 cmd.abm_set_pwm_frac.abm_set_pwm_frac_data.version = DMUB_CMD_ABM_CONTROL_VERSION_1; 71 cmd.abm_set_pwm_frac.abm_set_pwm_frac_data.panel_mask = panel_mask; 72 cmd.abm_set_pwm_frac.header.payload_bytes = sizeof(struct dmub_cmd_abm_set_pwm_frac_data); 73 74 dc_dmub_srv_cmd_queue(dc->dmub_srv, &cmd); 75 dc_dmub_srv_cmd_execute(dc->dmub_srv); 76 dc_dmub_srv_wait_idle(dc->dmub_srv); 77 } 78 79 static void dmub_abm_init(struct abm *abm, uint32_t backlight) 80 { 81 struct dce_abm *dce_abm = TO_DMUB_ABM(abm); 82 83 REG_WRITE(DC_ABM1_HG_SAMPLE_RATE, 0x3); 84 REG_WRITE(DC_ABM1_HG_SAMPLE_RATE, 0x1); 85 REG_WRITE(DC_ABM1_LS_SAMPLE_RATE, 0x3); 86 REG_WRITE(DC_ABM1_LS_SAMPLE_RATE, 0x1); 87 REG_WRITE(BL1_PWM_BL_UPDATE_SAMPLE_RATE, 0x1); 88 89 REG_SET_3(DC_ABM1_HG_MISC_CTRL, 0, 90 ABM1_HG_NUM_OF_BINS_SEL, 0, 91 ABM1_HG_VMAX_SEL, 1, 92 ABM1_HG_BIN_BITWIDTH_SIZE_SEL, 0); 93 94 REG_SET_3(DC_ABM1_IPCSC_COEFF_SEL, 0, 95 ABM1_IPCSC_COEFF_SEL_R, 2, 96 ABM1_IPCSC_COEFF_SEL_G, 4, 97 ABM1_IPCSC_COEFF_SEL_B, 2); 98 99 REG_UPDATE(BL1_PWM_CURRENT_ABM_LEVEL, 100 BL1_PWM_CURRENT_ABM_LEVEL, backlight); 101 102 REG_UPDATE(BL1_PWM_TARGET_ABM_LEVEL, 103 BL1_PWM_TARGET_ABM_LEVEL, backlight); 104 105 REG_UPDATE(BL1_PWM_USER_LEVEL, 106 BL1_PWM_USER_LEVEL, backlight); 107 108 REG_UPDATE_2(DC_ABM1_LS_MIN_MAX_PIXEL_VALUE_THRES, 109 ABM1_LS_MIN_PIXEL_VALUE_THRES, 0, 110 ABM1_LS_MAX_PIXEL_VALUE_THRES, 1000); 111 112 REG_SET_3(DC_ABM1_HGLS_REG_READ_PROGRESS, 0, 113 ABM1_HG_REG_READ_MISSED_FRAME_CLEAR, 1, 114 ABM1_LS_REG_READ_MISSED_FRAME_CLEAR, 1, 115 ABM1_BL_REG_READ_MISSED_FRAME_CLEAR, 1); 116 117 dmub_abm_enable_fractional_pwm(abm->ctx); 118 } 119 120 static unsigned int dmub_abm_get_current_backlight(struct abm *abm) 121 { 122 struct dce_abm *dce_abm = TO_DMUB_ABM(abm); 123 unsigned int backlight = REG_READ(BL1_PWM_CURRENT_ABM_LEVEL); 124 125 /* return backlight in hardware format which is unsigned 17 bits, with 126 * 1 bit integer and 16 bit fractional 127 */ 128 return backlight; 129 } 130 131 static unsigned int dmub_abm_get_target_backlight(struct abm *abm) 132 { 133 struct dce_abm *dce_abm = TO_DMUB_ABM(abm); 134 unsigned int backlight = REG_READ(BL1_PWM_TARGET_ABM_LEVEL); 135 136 /* return backlight in hardware format which is unsigned 17 bits, with 137 * 1 bit integer and 16 bit fractional 138 */ 139 return backlight; 140 } 141 142 static bool dmub_abm_set_level(struct abm *abm, uint32_t level) 143 { 144 union dmub_rb_cmd cmd; 145 struct dc_context *dc = abm->ctx; 146 struct dc_link *edp_links[MAX_NUM_EDP]; 147 int i; 148 int edp_num; 149 uint8_t panel_mask = 0; 150 151 get_edp_links(dc->dc, edp_links, &edp_num); 152 153 for (i = 0; i < edp_num; i++) { 154 if (edp_links[i]->link_status.link_active) 155 panel_mask |= (0x01 << i); 156 } 157 158 memset(&cmd, 0, sizeof(cmd)); 159 cmd.abm_set_level.header.type = DMUB_CMD__ABM; 160 cmd.abm_set_level.header.sub_type = DMUB_CMD__ABM_SET_LEVEL; 161 cmd.abm_set_level.abm_set_level_data.level = level; 162 cmd.abm_set_level.abm_set_level_data.version = DMUB_CMD_ABM_CONTROL_VERSION_1; 163 cmd.abm_set_level.abm_set_level_data.panel_mask = panel_mask; 164 cmd.abm_set_level.header.payload_bytes = sizeof(struct dmub_cmd_abm_set_level_data); 165 166 dc_dmub_srv_cmd_queue(dc->dmub_srv, &cmd); 167 dc_dmub_srv_cmd_execute(dc->dmub_srv); 168 dc_dmub_srv_wait_idle(dc->dmub_srv); 169 170 return true; 171 } 172 173 static bool dmub_abm_init_config(struct abm *abm, 174 const char *src, 175 unsigned int bytes) 176 { 177 union dmub_rb_cmd cmd; 178 struct dc_context *dc = abm->ctx; 179 uint32_t edp_id_count = dc->dc_edp_id_count; 180 int i; 181 uint8_t panel_mask = 0; 182 183 for (i = 0; i < edp_id_count; i++) 184 panel_mask |= 0x01 << i; 185 186 // TODO: Optimize by only reading back final 4 bytes 187 dmub_flush_buffer_mem(&dc->dmub_srv->dmub->scratch_mem_fb); 188 189 // Copy iramtable into cw7 190 memcpy(dc->dmub_srv->dmub->scratch_mem_fb.cpu_addr, (void *)src, bytes); 191 192 memset(&cmd, 0, sizeof(cmd)); 193 // Fw will copy from cw7 to fw_state 194 cmd.abm_init_config.header.type = DMUB_CMD__ABM; 195 cmd.abm_init_config.header.sub_type = DMUB_CMD__ABM_INIT_CONFIG; 196 cmd.abm_init_config.abm_init_config_data.src.quad_part = dc->dmub_srv->dmub->scratch_mem_fb.gpu_addr; 197 cmd.abm_init_config.abm_init_config_data.bytes = bytes; 198 cmd.abm_init_config.abm_init_config_data.version = DMUB_CMD_ABM_CONTROL_VERSION_1; 199 cmd.abm_init_config.abm_init_config_data.panel_mask = panel_mask; 200 201 cmd.abm_init_config.header.payload_bytes = sizeof(struct dmub_cmd_abm_init_config_data); 202 203 dc_dmub_srv_cmd_queue(dc->dmub_srv, &cmd); 204 dc_dmub_srv_cmd_execute(dc->dmub_srv); 205 dc_dmub_srv_wait_idle(dc->dmub_srv); 206 207 return true; 208 } 209 210 static const struct abm_funcs abm_funcs = { 211 .abm_init = dmub_abm_init, 212 .set_abm_level = dmub_abm_set_level, 213 .get_current_backlight = dmub_abm_get_current_backlight, 214 .get_target_backlight = dmub_abm_get_target_backlight, 215 .init_abm_config = dmub_abm_init_config, 216 }; 217 218 static void dmub_abm_construct( 219 struct dce_abm *abm_dce, 220 struct dc_context *ctx, 221 const struct dce_abm_registers *regs, 222 const struct dce_abm_shift *abm_shift, 223 const struct dce_abm_mask *abm_mask) 224 { 225 struct abm *base = &abm_dce->base; 226 227 base->ctx = ctx; 228 base->funcs = &abm_funcs; 229 base->dmcu_is_running = false; 230 231 abm_dce->regs = regs; 232 abm_dce->abm_shift = abm_shift; 233 abm_dce->abm_mask = abm_mask; 234 } 235 236 struct abm *dmub_abm_create( 237 struct dc_context *ctx, 238 const struct dce_abm_registers *regs, 239 const struct dce_abm_shift *abm_shift, 240 const struct dce_abm_mask *abm_mask) 241 { 242 struct dce_abm *abm_dce = kzalloc(sizeof(*abm_dce), GFP_KERNEL); 243 244 if (abm_dce == NULL) { 245 BREAK_TO_DEBUGGER(); 246 return NULL; 247 } 248 249 dmub_abm_construct(abm_dce, ctx, regs, abm_shift, abm_mask); 250 251 return &abm_dce->base; 252 } 253 254 void dmub_abm_destroy(struct abm **abm) 255 { 256 struct dce_abm *abm_dce = TO_DMUB_ABM(*abm); 257 258 kfree(abm_dce); 259 *abm = NULL; 260 } 261