1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Support for Intel Camera Imaging ISP subsystem. 4 * Copyright (c) 2015, Intel Corporation. 5 * 6 * This program is free software; you can redistribute it and/or modify it 7 * under the terms and conditions of the GNU General Public License, 8 * version 2, as published by the Free Software Foundation. 9 * 10 * This program is distributed in the hope it will be useful, but WITHOUT 11 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 12 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 13 * more details. 14 */ 15 16 #include "sh_css_param_dvs.h" 17 #include <assert_support.h> 18 #include <type_support.h> 19 #include <ia_css_err.h> 20 #include <ia_css_types.h> 21 #include "ia_css_debug.h" 22 23 static struct ia_css_dvs_6axis_config * 24 alloc_dvs_6axis_table(const struct ia_css_resolution *frame_res, 25 struct ia_css_dvs_6axis_config *dvs_config_src) 26 { 27 unsigned int width_y = 0; 28 unsigned int height_y = 0; 29 unsigned int width_uv = 0; 30 unsigned int height_uv = 0; 31 int err = 0; 32 struct ia_css_dvs_6axis_config *dvs_config = NULL; 33 34 dvs_config = kvmalloc(sizeof(struct ia_css_dvs_6axis_config), 35 GFP_KERNEL); 36 if (!dvs_config) { 37 IA_CSS_ERROR("out of memory"); 38 err = -ENOMEM; 39 } else { 40 /*Initialize new struct with latest config settings*/ 41 if (dvs_config_src) { 42 dvs_config->width_y = width_y = dvs_config_src->width_y; 43 dvs_config->height_y = height_y = dvs_config_src->height_y; 44 dvs_config->width_uv = width_uv = dvs_config_src->width_uv; 45 dvs_config->height_uv = height_uv = dvs_config_src->height_uv; 46 IA_CSS_LOG("alloc_dvs_6axis_table Y: W %d H %d", width_y, height_y); 47 } else if (frame_res) { 48 dvs_config->width_y = width_y = DVS_TABLE_IN_BLOCKDIM_X_LUMA(frame_res->width); 49 dvs_config->height_y = height_y = DVS_TABLE_IN_BLOCKDIM_Y_LUMA( 50 frame_res->height); 51 dvs_config->width_uv = width_uv = DVS_TABLE_IN_BLOCKDIM_X_CHROMA( 52 frame_res->width / 53 2); /* UV = Y/2, depens on colour format YUV 4.2.0*/ 54 dvs_config->height_uv = height_uv = DVS_TABLE_IN_BLOCKDIM_Y_CHROMA( 55 frame_res->height / 56 2);/* UV = Y/2, depens on colour format YUV 4.2.0*/ 57 IA_CSS_LOG("alloc_dvs_6axis_table Y: W %d H %d", width_y, height_y); 58 } 59 60 /* Generate Y buffers */ 61 dvs_config->xcoords_y = kvmalloc(width_y * height_y * sizeof(uint32_t), 62 GFP_KERNEL); 63 if (!dvs_config->xcoords_y) { 64 IA_CSS_ERROR("out of memory"); 65 err = -ENOMEM; 66 goto exit; 67 } 68 69 dvs_config->ycoords_y = kvmalloc(width_y * height_y * sizeof(uint32_t), 70 GFP_KERNEL); 71 if (!dvs_config->ycoords_y) { 72 IA_CSS_ERROR("out of memory"); 73 err = -ENOMEM; 74 goto exit; 75 } 76 77 /* Generate UV buffers */ 78 IA_CSS_LOG("UV W %d H %d", width_uv, height_uv); 79 80 dvs_config->xcoords_uv = kvmalloc(width_uv * height_uv * sizeof(uint32_t), 81 GFP_KERNEL); 82 if (!dvs_config->xcoords_uv) { 83 IA_CSS_ERROR("out of memory"); 84 err = -ENOMEM; 85 goto exit; 86 } 87 88 dvs_config->ycoords_uv = kvmalloc(width_uv * height_uv * sizeof(uint32_t), 89 GFP_KERNEL); 90 if (!dvs_config->ycoords_uv) { 91 IA_CSS_ERROR("out of memory"); 92 err = -ENOMEM; 93 } 94 exit: 95 if (err) { 96 free_dvs_6axis_table( 97 &dvs_config); /* we might have allocated some memory, release this */ 98 dvs_config = NULL; 99 } 100 } 101 102 IA_CSS_LEAVE("dvs_config=%p", dvs_config); 103 return dvs_config; 104 } 105 106 static void 107 init_dvs_6axis_table_from_default(struct ia_css_dvs_6axis_config *dvs_config, 108 const struct ia_css_resolution *dvs_offset) 109 { 110 unsigned int x, y; 111 unsigned int width_y = dvs_config->width_y; 112 unsigned int height_y = dvs_config->height_y; 113 unsigned int width_uv = dvs_config->width_uv; 114 unsigned int height_uv = dvs_config->height_uv; 115 116 IA_CSS_LOG("Env_X=%d, Env_Y=%d, width_y=%d, height_y=%d", 117 dvs_offset->width, dvs_offset->height, width_y, height_y); 118 for (y = 0; y < height_y; y++) { 119 for (x = 0; x < width_y; x++) { 120 dvs_config->xcoords_y[y * width_y + x] = (dvs_offset->width + x * 121 DVS_BLOCKDIM_X) << DVS_COORD_FRAC_BITS; 122 } 123 } 124 125 for (y = 0; y < height_y; y++) { 126 for (x = 0; x < width_y; x++) { 127 dvs_config->ycoords_y[y * width_y + x] = (dvs_offset->height + y * 128 DVS_BLOCKDIM_Y_LUMA) << DVS_COORD_FRAC_BITS; 129 } 130 } 131 132 for (y = 0; y < height_uv; y++) { 133 for (x = 0; x < width_uv; 134 x++) { /* Envelope dimensions set in Ypixels hence offset UV = offset Y/2 */ 135 dvs_config->xcoords_uv[y * width_uv + x] = ((dvs_offset->width / 2) + x * 136 DVS_BLOCKDIM_X) << DVS_COORD_FRAC_BITS; 137 } 138 } 139 140 for (y = 0; y < height_uv; y++) { 141 for (x = 0; x < width_uv; 142 x++) { /* Envelope dimensions set in Ypixels hence offset UV = offset Y/2 */ 143 dvs_config->ycoords_uv[y * width_uv + x] = ((dvs_offset->height / 2) + y * 144 DVS_BLOCKDIM_Y_CHROMA) << 145 DVS_COORD_FRAC_BITS; 146 } 147 } 148 } 149 150 static void 151 init_dvs_6axis_table_from_config(struct ia_css_dvs_6axis_config *dvs_config, 152 struct ia_css_dvs_6axis_config *dvs_config_src) 153 { 154 unsigned int width_y = dvs_config->width_y; 155 unsigned int height_y = dvs_config->height_y; 156 unsigned int width_uv = dvs_config->width_uv; 157 unsigned int height_uv = dvs_config->height_uv; 158 159 memcpy(dvs_config->xcoords_y, dvs_config_src->xcoords_y, 160 (width_y * height_y * sizeof(uint32_t))); 161 memcpy(dvs_config->ycoords_y, dvs_config_src->ycoords_y, 162 (width_y * height_y * sizeof(uint32_t))); 163 memcpy(dvs_config->xcoords_uv, dvs_config_src->xcoords_uv, 164 (width_uv * height_uv * sizeof(uint32_t))); 165 memcpy(dvs_config->ycoords_uv, dvs_config_src->ycoords_uv, 166 (width_uv * height_uv * sizeof(uint32_t))); 167 } 168 169 struct ia_css_dvs_6axis_config * 170 generate_dvs_6axis_table(const struct ia_css_resolution *frame_res, 171 const struct ia_css_resolution *dvs_offset) 172 { 173 struct ia_css_dvs_6axis_config *dvs_6axis_table; 174 175 assert(frame_res); 176 assert(dvs_offset); 177 178 dvs_6axis_table = alloc_dvs_6axis_table(frame_res, NULL); 179 if (dvs_6axis_table) { 180 init_dvs_6axis_table_from_default(dvs_6axis_table, dvs_offset); 181 return dvs_6axis_table; 182 } 183 return NULL; 184 } 185 186 struct ia_css_dvs_6axis_config * 187 generate_dvs_6axis_table_from_config(struct ia_css_dvs_6axis_config 188 *dvs_config_src) 189 { 190 struct ia_css_dvs_6axis_config *dvs_6axis_table; 191 192 assert(dvs_config_src); 193 194 dvs_6axis_table = alloc_dvs_6axis_table(NULL, dvs_config_src); 195 if (dvs_6axis_table) { 196 init_dvs_6axis_table_from_config(dvs_6axis_table, dvs_config_src); 197 return dvs_6axis_table; 198 } 199 return NULL; 200 } 201 202 void 203 free_dvs_6axis_table(struct ia_css_dvs_6axis_config **dvs_6axis_config) 204 { 205 assert(dvs_6axis_config); 206 assert(*dvs_6axis_config); 207 208 if ((dvs_6axis_config) && (*dvs_6axis_config)) { 209 IA_CSS_ENTER_PRIVATE("dvs_6axis_config %p", (*dvs_6axis_config)); 210 if ((*dvs_6axis_config)->xcoords_y) { 211 kvfree((*dvs_6axis_config)->xcoords_y); 212 (*dvs_6axis_config)->xcoords_y = NULL; 213 } 214 215 if ((*dvs_6axis_config)->ycoords_y) { 216 kvfree((*dvs_6axis_config)->ycoords_y); 217 (*dvs_6axis_config)->ycoords_y = NULL; 218 } 219 220 /* Free up UV buffers */ 221 if ((*dvs_6axis_config)->xcoords_uv) { 222 kvfree((*dvs_6axis_config)->xcoords_uv); 223 (*dvs_6axis_config)->xcoords_uv = NULL; 224 } 225 226 if ((*dvs_6axis_config)->ycoords_uv) { 227 kvfree((*dvs_6axis_config)->ycoords_uv); 228 (*dvs_6axis_config)->ycoords_uv = NULL; 229 } 230 231 IA_CSS_LEAVE_PRIVATE("dvs_6axis_config %p", (*dvs_6axis_config)); 232 kvfree(*dvs_6axis_config); 233 *dvs_6axis_config = NULL; 234 } 235 } 236 237 void copy_dvs_6axis_table(struct ia_css_dvs_6axis_config *dvs_config_dst, 238 const struct ia_css_dvs_6axis_config *dvs_config_src) 239 { 240 unsigned int width_y; 241 unsigned int height_y; 242 unsigned int width_uv; 243 unsigned int height_uv; 244 245 assert(dvs_config_src); 246 assert(dvs_config_dst); 247 assert(dvs_config_src->xcoords_y); 248 assert(dvs_config_src->xcoords_uv); 249 assert(dvs_config_src->ycoords_y); 250 assert(dvs_config_src->ycoords_uv); 251 assert(dvs_config_src->width_y == dvs_config_dst->width_y); 252 assert(dvs_config_src->width_uv == dvs_config_dst->width_uv); 253 assert(dvs_config_src->height_y == dvs_config_dst->height_y); 254 assert(dvs_config_src->height_uv == dvs_config_dst->height_uv); 255 256 width_y = dvs_config_src->width_y; 257 height_y = dvs_config_src->height_y; 258 width_uv = 259 dvs_config_src->width_uv; /* = Y/2, depens on colour format YUV 4.2.0*/ 260 height_uv = dvs_config_src->height_uv; 261 262 memcpy(dvs_config_dst->xcoords_y, dvs_config_src->xcoords_y, 263 (width_y * height_y * sizeof(uint32_t))); 264 memcpy(dvs_config_dst->ycoords_y, dvs_config_src->ycoords_y, 265 (width_y * height_y * sizeof(uint32_t))); 266 267 memcpy(dvs_config_dst->xcoords_uv, dvs_config_src->xcoords_uv, 268 (width_uv * height_uv * sizeof(uint32_t))); 269 memcpy(dvs_config_dst->ycoords_uv, dvs_config_src->ycoords_uv, 270 (width_uv * height_uv * sizeof(uint32_t))); 271 } 272 273 void 274 ia_css_dvs_statistics_get(enum dvs_statistics_type type, 275 union ia_css_dvs_statistics_host *host_stats, 276 const union ia_css_dvs_statistics_isp *isp_stats) 277 { 278 if (type == DVS_STATISTICS) { 279 ia_css_get_dvs_statistics(host_stats->p_dvs_statistics_host, 280 isp_stats->p_dvs_statistics_isp); 281 } else if (type == DVS2_STATISTICS) { 282 ia_css_get_dvs2_statistics(host_stats->p_dvs2_statistics_host, 283 isp_stats->p_dvs_statistics_isp); 284 } 285 return; 286 } 287