1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Support for Intel Camera Imaging ISP subsystem.
4 * Copyright (c) 2010-2015, Intel Corporation.
5 */
6
7 #include "system_global.h"
8
9
10 #include "input_formatter.h"
11 #include <type_support.h>
12 #include "gp_device.h"
13
14 #include "assert_support.h"
15
16 #ifndef __INLINE_INPUT_FORMATTER__
17 #include "input_formatter_private.h"
18 #endif /* __INLINE_INPUT_FORMATTER__ */
19
20 static const unsigned int input_formatter_alignment[N_INPUT_FORMATTER_ID] = {
21 ISP_VEC_ALIGN, ISP_VEC_ALIGN, HIVE_ISP_CTRL_DATA_BYTES
22 };
23
24 const hrt_address HIVE_IF_SRST_ADDRESS[N_INPUT_FORMATTER_ID] = {
25 INPUT_FORMATTER0_SRST_OFFSET,
26 INPUT_FORMATTER1_SRST_OFFSET,
27 INPUT_FORMATTER2_SRST_OFFSET,
28 INPUT_FORMATTER3_SRST_OFFSET
29 };
30
31 const hrt_data HIVE_IF_SRST_MASK[N_INPUT_FORMATTER_ID] = {
32 INPUT_FORMATTER0_SRST_MASK,
33 INPUT_FORMATTER1_SRST_MASK,
34 INPUT_FORMATTER2_SRST_MASK,
35 INPUT_FORMATTER3_SRST_MASK
36 };
37
38 const u8 HIVE_IF_SWITCH_CODE[N_INPUT_FORMATTER_ID] = {
39 HIVE_INPUT_SWITCH_SELECT_IF_PRIM,
40 HIVE_INPUT_SWITCH_SELECT_IF_PRIM,
41 HIVE_INPUT_SWITCH_SELECT_IF_SEC,
42 HIVE_INPUT_SWITCH_SELECT_STR_TO_MEM
43 };
44
45 /* MW Should be part of system_global.h, where we have the main enumeration */
46 static const bool HIVE_IF_BIN_COPY[N_INPUT_FORMATTER_ID] = {
47 false, false, false, true
48 };
49
input_formatter_rst(const input_formatter_ID_t ID)50 void input_formatter_rst(
51 const input_formatter_ID_t ID)
52 {
53 hrt_address addr;
54 hrt_data rst;
55
56 assert(ID < N_INPUT_FORMATTER_ID);
57
58 addr = HIVE_IF_SRST_ADDRESS[ID];
59 rst = HIVE_IF_SRST_MASK[ID];
60
61 /* TEMPORARY HACK: THIS RESET BREAKS THE METADATA FEATURE
62 * WICH USES THE STREAM2MEMRY BLOCK.
63 * MUST BE FIXED PROPERLY
64 */
65 if (!HIVE_IF_BIN_COPY[ID]) {
66 input_formatter_reg_store(ID, addr, rst);
67 }
68
69 return;
70 }
71
input_formatter_get_alignment(const input_formatter_ID_t ID)72 unsigned int input_formatter_get_alignment(
73 const input_formatter_ID_t ID)
74 {
75 assert(ID < N_INPUT_FORMATTER_ID);
76
77 return input_formatter_alignment[ID];
78 }
79
input_formatter_set_fifo_blocking_mode(const input_formatter_ID_t ID,const bool enable)80 void input_formatter_set_fifo_blocking_mode(
81 const input_formatter_ID_t ID,
82 const bool enable)
83 {
84 assert(ID < N_INPUT_FORMATTER_ID);
85
86 /* cnd_input_formatter_reg_store() */
87 if (!HIVE_IF_BIN_COPY[ID]) {
88 input_formatter_reg_store(ID,
89 HIVE_IF_BLOCK_FIFO_NO_REQ_ADDRESS, enable);
90 }
91 return;
92 }
93
input_formatter_get_switch_state(const input_formatter_ID_t ID,input_formatter_switch_state_t * state)94 void input_formatter_get_switch_state(
95 const input_formatter_ID_t ID,
96 input_formatter_switch_state_t *state)
97 {
98 assert(ID < N_INPUT_FORMATTER_ID);
99 assert(state);
100
101 /* We'll change this into an intelligent function to get switch info per IF */
102 (void)ID;
103
104 state->if_input_switch_lut_reg[0] = gp_device_reg_load(GP_DEVICE0_ID,
105 _REG_GP_IFMT_input_switch_lut_reg0);
106 state->if_input_switch_lut_reg[1] = gp_device_reg_load(GP_DEVICE0_ID,
107 _REG_GP_IFMT_input_switch_lut_reg1);
108 state->if_input_switch_lut_reg[2] = gp_device_reg_load(GP_DEVICE0_ID,
109 _REG_GP_IFMT_input_switch_lut_reg2);
110 state->if_input_switch_lut_reg[3] = gp_device_reg_load(GP_DEVICE0_ID,
111 _REG_GP_IFMT_input_switch_lut_reg3);
112 state->if_input_switch_lut_reg[4] = gp_device_reg_load(GP_DEVICE0_ID,
113 _REG_GP_IFMT_input_switch_lut_reg4);
114 state->if_input_switch_lut_reg[5] = gp_device_reg_load(GP_DEVICE0_ID,
115 _REG_GP_IFMT_input_switch_lut_reg5);
116 state->if_input_switch_lut_reg[6] = gp_device_reg_load(GP_DEVICE0_ID,
117 _REG_GP_IFMT_input_switch_lut_reg6);
118 state->if_input_switch_lut_reg[7] = gp_device_reg_load(GP_DEVICE0_ID,
119 _REG_GP_IFMT_input_switch_lut_reg7);
120 state->if_input_switch_fsync_lut = gp_device_reg_load(GP_DEVICE0_ID,
121 _REG_GP_IFMT_input_switch_fsync_lut);
122 state->if_input_switch_ch_id_fmt_type = gp_device_reg_load(GP_DEVICE0_ID,
123 _REG_GP_IFMT_input_switch_ch_id_fmt_type);
124
125 return;
126 }
127
input_formatter_get_state(const input_formatter_ID_t ID,input_formatter_state_t * state)128 void input_formatter_get_state(
129 const input_formatter_ID_t ID,
130 input_formatter_state_t *state)
131 {
132 assert(ID < N_INPUT_FORMATTER_ID);
133 assert(state);
134 /*
135 state->reset = input_formatter_reg_load(ID,
136 HIVE_IF_RESET_ADDRESS);
137 */
138 state->start_line = input_formatter_reg_load(ID,
139 HIVE_IF_START_LINE_ADDRESS);
140 state->start_column = input_formatter_reg_load(ID,
141 HIVE_IF_START_COLUMN_ADDRESS);
142 state->cropped_height = input_formatter_reg_load(ID,
143 HIVE_IF_CROPPED_HEIGHT_ADDRESS);
144 state->cropped_width = input_formatter_reg_load(ID,
145 HIVE_IF_CROPPED_WIDTH_ADDRESS);
146 state->ver_decimation = input_formatter_reg_load(ID,
147 HIVE_IF_VERTICAL_DECIMATION_ADDRESS);
148 state->hor_decimation = input_formatter_reg_load(ID,
149 HIVE_IF_HORIZONTAL_DECIMATION_ADDRESS);
150 state->hor_deinterleaving = input_formatter_reg_load(ID,
151 HIVE_IF_H_DEINTERLEAVING_ADDRESS);
152 state->left_padding = input_formatter_reg_load(ID,
153 HIVE_IF_LEFTPADDING_WIDTH_ADDRESS);
154 state->eol_offset = input_formatter_reg_load(ID,
155 HIVE_IF_END_OF_LINE_OFFSET_ADDRESS);
156 state->vmem_start_address = input_formatter_reg_load(ID,
157 HIVE_IF_VMEM_START_ADDRESS_ADDRESS);
158 state->vmem_end_address = input_formatter_reg_load(ID,
159 HIVE_IF_VMEM_END_ADDRESS_ADDRESS);
160 state->vmem_increment = input_formatter_reg_load(ID,
161 HIVE_IF_VMEM_INCREMENT_ADDRESS);
162 state->is_yuv420 = input_formatter_reg_load(ID,
163 HIVE_IF_YUV_420_FORMAT_ADDRESS);
164 state->vsync_active_low = input_formatter_reg_load(ID,
165 HIVE_IF_VSYNCK_ACTIVE_LOW_ADDRESS);
166 state->hsync_active_low = input_formatter_reg_load(ID,
167 HIVE_IF_HSYNCK_ACTIVE_LOW_ADDRESS);
168 state->allow_fifo_overflow = input_formatter_reg_load(ID,
169 HIVE_IF_ALLOW_FIFO_OVERFLOW_ADDRESS);
170 state->block_fifo_when_no_req = input_formatter_reg_load(ID,
171 HIVE_IF_BLOCK_FIFO_NO_REQ_ADDRESS);
172 state->ver_deinterleaving = input_formatter_reg_load(ID,
173 HIVE_IF_V_DEINTERLEAVING_ADDRESS);
174 /* FSM */
175 state->fsm_sync_status = input_formatter_reg_load(ID,
176 HIVE_IF_FSM_SYNC_STATUS);
177 state->fsm_sync_counter = input_formatter_reg_load(ID,
178 HIVE_IF_FSM_SYNC_COUNTER);
179 state->fsm_crop_status = input_formatter_reg_load(ID,
180 HIVE_IF_FSM_CROP_STATUS);
181 state->fsm_crop_line_counter = input_formatter_reg_load(ID,
182 HIVE_IF_FSM_CROP_LINE_COUNTER);
183 state->fsm_crop_pixel_counter = input_formatter_reg_load(ID,
184 HIVE_IF_FSM_CROP_PIXEL_COUNTER);
185 state->fsm_deinterleaving_index = input_formatter_reg_load(ID,
186 HIVE_IF_FSM_DEINTERLEAVING_IDX);
187 state->fsm_dec_h_counter = input_formatter_reg_load(ID,
188 HIVE_IF_FSM_DECIMATION_H_COUNTER);
189 state->fsm_dec_v_counter = input_formatter_reg_load(ID,
190 HIVE_IF_FSM_DECIMATION_V_COUNTER);
191 state->fsm_dec_block_v_counter = input_formatter_reg_load(ID,
192 HIVE_IF_FSM_DECIMATION_BLOCK_V_COUNTER);
193 state->fsm_padding_status = input_formatter_reg_load(ID,
194 HIVE_IF_FSM_PADDING_STATUS);
195 state->fsm_padding_elem_counter = input_formatter_reg_load(ID,
196 HIVE_IF_FSM_PADDING_ELEMENT_COUNTER);
197 state->fsm_vector_support_error = input_formatter_reg_load(ID,
198 HIVE_IF_FSM_VECTOR_SUPPORT_ERROR);
199 state->fsm_vector_buffer_full = input_formatter_reg_load(ID,
200 HIVE_IF_FSM_VECTOR_SUPPORT_BUFF_FULL);
201 state->vector_support = input_formatter_reg_load(ID,
202 HIVE_IF_FSM_VECTOR_SUPPORT);
203 state->sensor_data_lost = input_formatter_reg_load(ID,
204 HIVE_IF_FIFO_SENSOR_STATUS);
205
206 return;
207 }
208
input_formatter_bin_get_state(const input_formatter_ID_t ID,input_formatter_bin_state_t * state)209 void input_formatter_bin_get_state(
210 const input_formatter_ID_t ID,
211 input_formatter_bin_state_t *state)
212 {
213 assert(ID < N_INPUT_FORMATTER_ID);
214 assert(state);
215
216 state->reset = input_formatter_reg_load(ID,
217 HIVE_STR2MEM_SOFT_RESET_REG_ADDRESS);
218 state->input_endianness = input_formatter_reg_load(ID,
219 HIVE_STR2MEM_INPUT_ENDIANNESS_REG_ADDRESS);
220 state->output_endianness = input_formatter_reg_load(ID,
221 HIVE_STR2MEM_OUTPUT_ENDIANNESS_REG_ADDRESS);
222 state->bitswap = input_formatter_reg_load(ID,
223 HIVE_STR2MEM_BIT_SWAPPING_REG_ADDRESS);
224 state->block_synch = input_formatter_reg_load(ID,
225 HIVE_STR2MEM_BLOCK_SYNC_LEVEL_REG_ADDRESS);
226 state->packet_synch = input_formatter_reg_load(ID,
227 HIVE_STR2MEM_PACKET_SYNC_LEVEL_REG_ADDRESS);
228 state->readpostwrite_synch = input_formatter_reg_load(ID,
229 HIVE_STR2MEM_READ_POST_WRITE_SYNC_ENABLE_REG_ADDRESS);
230 state->is_2ppc = input_formatter_reg_load(ID,
231 HIVE_STR2MEM_DUAL_BYTE_INPUTS_ENABLED_REG_ADDRESS);
232 state->en_status_update = input_formatter_reg_load(ID,
233 HIVE_STR2MEM_EN_STAT_UPDATE_ADDRESS);
234 return;
235 }
236