1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Copyright (C) Marvell International Ltd. and its affiliates 4 */ 5 6 #include <common.h> 7 #include <spl.h> 8 #include <asm/io.h> 9 #include <asm/arch/cpu.h> 10 #include <asm/arch/soc.h> 11 12 #include "seq_exec.h" 13 #include "high_speed_env_spec.h" 14 15 #include "../../../drivers/ddr/marvell/a38x/ddr3_init.h" 16 17 #if defined(MV_DEBUG_INIT_FULL) || defined(MV_DEBUG) 18 #define DB(x) x 19 #else 20 #define DB(x) 21 #endif 22 23 /* Array for mapping the operation (write, poll or delay) functions */ 24 op_execute_func_ptr op_execute_func_arr[] = { 25 write_op_execute, 26 delay_op_execute, 27 poll_op_execute 28 }; 29 30 int write_op_execute(u32 serdes_num, struct op_params *params, u32 data_arr_idx) 31 { 32 u32 unit_base_reg, unit_offset, data, mask, reg_data, reg_addr; 33 34 /* Getting write op params from the input parameter */ 35 data = params->data[data_arr_idx]; 36 mask = params->mask; 37 38 /* an empty operation */ 39 if (data == NO_DATA) 40 return MV_OK; 41 42 /* get updated base address since it can be different between Serdes */ 43 CHECK_STATUS(hws_get_ext_base_addr(serdes_num, params->unit_base_reg, 44 params->unit_offset, 45 &unit_base_reg, &unit_offset)); 46 47 /* Address calculation */ 48 reg_addr = unit_base_reg + unit_offset * serdes_num; 49 50 #ifdef SEQ_DEBUG 51 printf("Write: 0x%x: 0x%x (mask 0x%x) - ", reg_addr, data, mask); 52 #endif 53 /* Reading old value */ 54 reg_data = reg_read(reg_addr); 55 reg_data &= (~mask); 56 57 /* Writing new data */ 58 data &= mask; 59 reg_data |= data; 60 reg_write(reg_addr, reg_data); 61 62 #ifdef SEQ_DEBUG 63 printf(" - 0x%x\n", reg_data); 64 #endif 65 66 return MV_OK; 67 } 68 69 int delay_op_execute(u32 serdes_num, struct op_params *params, u32 data_arr_idx) 70 { 71 u32 delay; 72 73 /* Getting delay op params from the input parameter */ 74 delay = params->wait_time; 75 #ifdef SEQ_DEBUG 76 printf("Delay: %d\n", delay); 77 #endif 78 mdelay(delay); 79 80 return MV_OK; 81 } 82 83 int poll_op_execute(u32 serdes_num, struct op_params *params, u32 data_arr_idx) 84 { 85 u32 unit_base_reg, unit_offset, data, mask, num_of_loops, wait_time; 86 u32 poll_counter = 0; 87 u32 reg_addr, reg_data; 88 89 /* Getting poll op params from the input parameter */ 90 data = params->data[data_arr_idx]; 91 mask = params->mask; 92 num_of_loops = params->num_of_loops; 93 wait_time = params->wait_time; 94 95 /* an empty operation */ 96 if (data == NO_DATA) 97 return MV_OK; 98 99 /* get updated base address since it can be different between Serdes */ 100 CHECK_STATUS(hws_get_ext_base_addr(serdes_num, params->unit_base_reg, 101 params->unit_offset, 102 &unit_base_reg, &unit_offset)); 103 104 /* Address calculation */ 105 reg_addr = unit_base_reg + unit_offset * serdes_num; 106 107 /* Polling */ 108 #ifdef SEQ_DEBUG 109 printf("Poll: 0x%x: 0x%x (mask 0x%x)\n", reg_addr, data, mask); 110 #endif 111 112 do { 113 reg_data = reg_read(reg_addr) & mask; 114 poll_counter++; 115 udelay(wait_time); 116 } while ((reg_data != data) && (poll_counter < num_of_loops)); 117 118 if ((poll_counter >= num_of_loops) && (reg_data != data)) { 119 DEBUG_INIT_S("poll_op_execute: TIMEOUT\n"); 120 return MV_TIMEOUT; 121 } 122 123 return MV_OK; 124 } 125 126 enum mv_op get_cfg_seq_op(struct op_params *params) 127 { 128 if (params->wait_time == 0) 129 return WRITE_OP; 130 else if (params->num_of_loops == 0) 131 return DELAY_OP; 132 133 return POLL_OP; 134 } 135 136 int mv_seq_exec(u32 serdes_num, u32 seq_id) 137 { 138 u32 seq_idx; 139 struct op_params *seq_arr; 140 u32 seq_size; 141 u32 data_arr_idx; 142 enum mv_op curr_op; 143 144 DB(printf("\n### mv_seq_exec ###\n")); 145 DB(printf("seq id: %d\n", seq_id)); 146 147 if (hws_is_serdes_active(serdes_num) != 1) { 148 printf("mv_seq_exec_ext:Error: SerDes lane %d is not valid\n", 149 serdes_num); 150 return MV_BAD_PARAM; 151 } 152 153 seq_arr = serdes_seq_db[seq_id].op_params_ptr; 154 seq_size = serdes_seq_db[seq_id].cfg_seq_size; 155 data_arr_idx = serdes_seq_db[seq_id].data_arr_idx; 156 157 DB(printf("seq_size: %d\n", seq_size)); 158 DB(printf("data_arr_idx: %d\n", data_arr_idx)); 159 160 /* Executing the sequence operations */ 161 for (seq_idx = 0; seq_idx < seq_size; seq_idx++) { 162 curr_op = get_cfg_seq_op(&seq_arr[seq_idx]); 163 op_execute_func_arr[curr_op](serdes_num, &seq_arr[seq_idx], 164 data_arr_idx); 165 } 166 167 return MV_OK; 168 } 169
