1f5fbb83fSMauro Carvalho Chehab // SPDX-License-Identifier: GPL-2.0
29d4fa1a1SMauro Carvalho Chehab /*
39d4fa1a1SMauro Carvalho Chehab  * Support for Intel Camera Imaging ISP subsystem.
49d4fa1a1SMauro Carvalho Chehab  * Copyright (c) 2015, Intel Corporation.
59d4fa1a1SMauro Carvalho Chehab  *
69d4fa1a1SMauro Carvalho Chehab  * This program is free software; you can redistribute it and/or modify it
79d4fa1a1SMauro Carvalho Chehab  * under the terms and conditions of the GNU General Public License,
89d4fa1a1SMauro Carvalho Chehab  * version 2, as published by the Free Software Foundation.
99d4fa1a1SMauro Carvalho Chehab  *
109d4fa1a1SMauro Carvalho Chehab  * This program is distributed in the hope it will be useful, but WITHOUT
119d4fa1a1SMauro Carvalho Chehab  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
129d4fa1a1SMauro Carvalho Chehab  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
139d4fa1a1SMauro Carvalho Chehab  * more details.
149d4fa1a1SMauro Carvalho Chehab  */
159d4fa1a1SMauro Carvalho Chehab 
169d4fa1a1SMauro Carvalho Chehab #include "ia_css_frame.h"
179d4fa1a1SMauro Carvalho Chehab #include "ia_css_debug.h"
189d4fa1a1SMauro Carvalho Chehab #define IA_CSS_INCLUDE_CONFIGURATIONS
199d4fa1a1SMauro Carvalho Chehab #include "ia_css_isp_configs.h"
209d4fa1a1SMauro Carvalho Chehab #include "ia_css_output.host.h"
219d4fa1a1SMauro Carvalho Chehab #include "isp.h"
229d4fa1a1SMauro Carvalho Chehab 
239d4fa1a1SMauro Carvalho Chehab #include "assert_support.h"
249d4fa1a1SMauro Carvalho Chehab 
259d4fa1a1SMauro Carvalho Chehab const struct ia_css_output_config default_output_config = {
269d4fa1a1SMauro Carvalho Chehab 	0,
279d4fa1a1SMauro Carvalho Chehab 	0
289d4fa1a1SMauro Carvalho Chehab };
299d4fa1a1SMauro Carvalho Chehab 
309d4fa1a1SMauro Carvalho Chehab static const struct ia_css_output_configuration default_output_configuration = {
319d4fa1a1SMauro Carvalho Chehab 	.info = (struct ia_css_frame_info *)NULL,
329d4fa1a1SMauro Carvalho Chehab };
339d4fa1a1SMauro Carvalho Chehab 
349d4fa1a1SMauro Carvalho Chehab static const struct ia_css_output0_configuration default_output0_configuration
359d4fa1a1SMauro Carvalho Chehab 	= {
369d4fa1a1SMauro Carvalho Chehab 	.info = (struct ia_css_frame_info *)NULL,
379d4fa1a1SMauro Carvalho Chehab };
389d4fa1a1SMauro Carvalho Chehab 
399d4fa1a1SMauro Carvalho Chehab static const struct ia_css_output1_configuration default_output1_configuration
409d4fa1a1SMauro Carvalho Chehab 	= {
419d4fa1a1SMauro Carvalho Chehab 	.info = (struct ia_css_frame_info *)NULL,
429d4fa1a1SMauro Carvalho Chehab };
439d4fa1a1SMauro Carvalho Chehab 
449d4fa1a1SMauro Carvalho Chehab void
ia_css_output_encode(struct sh_css_isp_output_params * to,const struct ia_css_output_config * from,unsigned int size)459d4fa1a1SMauro Carvalho Chehab ia_css_output_encode(
469d4fa1a1SMauro Carvalho Chehab     struct sh_css_isp_output_params *to,
479d4fa1a1SMauro Carvalho Chehab     const struct ia_css_output_config *from,
489d4fa1a1SMauro Carvalho Chehab     unsigned int size)
499d4fa1a1SMauro Carvalho Chehab {
509d4fa1a1SMauro Carvalho Chehab 	(void)size;
519d4fa1a1SMauro Carvalho Chehab 	to->enable_hflip = from->enable_hflip;
529d4fa1a1SMauro Carvalho Chehab 	to->enable_vflip = from->enable_vflip;
539d4fa1a1SMauro Carvalho Chehab }
549d4fa1a1SMauro Carvalho Chehab 
ia_css_output_config(struct sh_css_isp_output_isp_config * to,const struct ia_css_output_configuration * from,unsigned int size)55874da1fdSMauro Carvalho Chehab int ia_css_output_config(struct sh_css_isp_output_isp_config *to,
569d4fa1a1SMauro Carvalho Chehab 			 const struct ia_css_output_configuration  *from,
579d4fa1a1SMauro Carvalho Chehab 			 unsigned int size)
589d4fa1a1SMauro Carvalho Chehab {
599d4fa1a1SMauro Carvalho Chehab 	unsigned int elems_a = ISP_VEC_NELEMS;
60*62596705SMauro Carvalho Chehab 	int ret;
619d4fa1a1SMauro Carvalho Chehab 
62*62596705SMauro Carvalho Chehab 	ret = ia_css_dma_configure_from_info(&to->port_b, from->info);
63*62596705SMauro Carvalho Chehab 	if (ret)
64*62596705SMauro Carvalho Chehab 		return ret;
65*62596705SMauro Carvalho Chehab 
669d4fa1a1SMauro Carvalho Chehab 	to->width_a_over_b = elems_a / to->port_b.elems;
679d4fa1a1SMauro Carvalho Chehab 	to->height = from->info ? from->info->res.height : 0;
689d4fa1a1SMauro Carvalho Chehab 	to->enable = from->info != NULL;
699d4fa1a1SMauro Carvalho Chehab 	ia_css_frame_info_to_frame_sp_info(&to->info, from->info);
709d4fa1a1SMauro Carvalho Chehab 
719d4fa1a1SMauro Carvalho Chehab 	/* Assume divisiblity here, may need to generalize to fixed point. */
72*62596705SMauro Carvalho Chehab 	if (elems_a % to->port_b.elems != 0)
73*62596705SMauro Carvalho Chehab 		return -EINVAL;
74*62596705SMauro Carvalho Chehab 
75874da1fdSMauro Carvalho Chehab 	return 0;
769d4fa1a1SMauro Carvalho Chehab }
779d4fa1a1SMauro Carvalho Chehab 
ia_css_output0_config(struct sh_css_isp_output_isp_config * to,const struct ia_css_output0_configuration * from,unsigned int size)78874da1fdSMauro Carvalho Chehab int ia_css_output0_config(struct sh_css_isp_output_isp_config       *to,
799d4fa1a1SMauro Carvalho Chehab 			  const struct ia_css_output0_configuration *from,
809d4fa1a1SMauro Carvalho Chehab 			  unsigned int size)
819d4fa1a1SMauro Carvalho Chehab {
82874da1fdSMauro Carvalho Chehab 	return ia_css_output_config(to, (const struct ia_css_output_configuration *)from, size);
839d4fa1a1SMauro Carvalho Chehab }
849d4fa1a1SMauro Carvalho Chehab 
ia_css_output1_config(struct sh_css_isp_output_isp_config * to,const struct ia_css_output1_configuration * from,unsigned int size)85874da1fdSMauro Carvalho Chehab int ia_css_output1_config(struct sh_css_isp_output_isp_config       *to,
869d4fa1a1SMauro Carvalho Chehab 		          const struct ia_css_output1_configuration *from,
879d4fa1a1SMauro Carvalho Chehab 			  unsigned int size)
889d4fa1a1SMauro Carvalho Chehab {
89874da1fdSMauro Carvalho Chehab 	return ia_css_output_config(to, (const struct ia_css_output_configuration *)from, size);
909d4fa1a1SMauro Carvalho Chehab }
919d4fa1a1SMauro Carvalho Chehab 
ia_css_output_configure(const struct ia_css_binary * binary,const struct ia_css_frame_info * info)92f21e49beSMauro Carvalho Chehab int ia_css_output_configure(const struct ia_css_binary     *binary,
939d4fa1a1SMauro Carvalho Chehab 			    const struct ia_css_frame_info *info)
949d4fa1a1SMauro Carvalho Chehab {
959d4fa1a1SMauro Carvalho Chehab 	if (info) {
969d4fa1a1SMauro Carvalho Chehab 		struct ia_css_output_configuration config =
979d4fa1a1SMauro Carvalho Chehab 			    default_output_configuration;
989d4fa1a1SMauro Carvalho Chehab 
999d4fa1a1SMauro Carvalho Chehab 		config.info = info;
1009d4fa1a1SMauro Carvalho Chehab 
101f21e49beSMauro Carvalho Chehab 		return ia_css_configure_output(binary, &config);
1029d4fa1a1SMauro Carvalho Chehab 	}
103f21e49beSMauro Carvalho Chehab 	return 0;
1049d4fa1a1SMauro Carvalho Chehab }
1059d4fa1a1SMauro Carvalho Chehab 
ia_css_output0_configure(const struct ia_css_binary * binary,const struct ia_css_frame_info * info)106f21e49beSMauro Carvalho Chehab int ia_css_output0_configure(const struct ia_css_binary    *binary,
1079d4fa1a1SMauro Carvalho Chehab 			    const struct ia_css_frame_info *info)
1089d4fa1a1SMauro Carvalho Chehab {
1099d4fa1a1SMauro Carvalho Chehab 	if (info) {
1109d4fa1a1SMauro Carvalho Chehab 		struct ia_css_output0_configuration config =
1119d4fa1a1SMauro Carvalho Chehab 			    default_output0_configuration;
1129d4fa1a1SMauro Carvalho Chehab 
1139d4fa1a1SMauro Carvalho Chehab 		config.info = info;
1149d4fa1a1SMauro Carvalho Chehab 
115f21e49beSMauro Carvalho Chehab 		return ia_css_configure_output0(binary, &config);
1169d4fa1a1SMauro Carvalho Chehab 	}
117f21e49beSMauro Carvalho Chehab 	return 0;
1189d4fa1a1SMauro Carvalho Chehab }
1199d4fa1a1SMauro Carvalho Chehab 
ia_css_output1_configure(const struct ia_css_binary * binary,const struct ia_css_frame_info * info)120f21e49beSMauro Carvalho Chehab int ia_css_output1_configure(const struct ia_css_binary     *binary,
1219d4fa1a1SMauro Carvalho Chehab 			     const struct ia_css_frame_info *info)
1229d4fa1a1SMauro Carvalho Chehab {
1239d4fa1a1SMauro Carvalho Chehab 	if (info) {
1249d4fa1a1SMauro Carvalho Chehab 		struct ia_css_output1_configuration config =
1259d4fa1a1SMauro Carvalho Chehab 			    default_output1_configuration;
1269d4fa1a1SMauro Carvalho Chehab 
1279d4fa1a1SMauro Carvalho Chehab 		config.info = info;
1289d4fa1a1SMauro Carvalho Chehab 
129f21e49beSMauro Carvalho Chehab 		return ia_css_configure_output1(binary, &config);
1309d4fa1a1SMauro Carvalho Chehab 	}
131f21e49beSMauro Carvalho Chehab 	return 0;
1329d4fa1a1SMauro Carvalho Chehab }
1339d4fa1a1SMauro Carvalho Chehab 
1349d4fa1a1SMauro Carvalho Chehab void
ia_css_output_dump(const struct sh_css_isp_output_params * output,unsigned int level)1359d4fa1a1SMauro Carvalho Chehab ia_css_output_dump(
1369d4fa1a1SMauro Carvalho Chehab     const struct sh_css_isp_output_params *output,
1379d4fa1a1SMauro Carvalho Chehab     unsigned int level)
1389d4fa1a1SMauro Carvalho Chehab {
1399d4fa1a1SMauro Carvalho Chehab 	if (!output) return;
1409d4fa1a1SMauro Carvalho Chehab 	ia_css_debug_dtrace(level, "Horizontal Output Flip:\n");
1419d4fa1a1SMauro Carvalho Chehab 	ia_css_debug_dtrace(level, "\t%-32s = %d\n",
1429d4fa1a1SMauro Carvalho Chehab 			    "enable", output->enable_hflip);
1439d4fa1a1SMauro Carvalho Chehab 	ia_css_debug_dtrace(level, "Vertical Output Flip:\n");
1449d4fa1a1SMauro Carvalho Chehab 	ia_css_debug_dtrace(level, "\t%-32s = %d\n",
1459d4fa1a1SMauro Carvalho Chehab 			    "enable", output->enable_vflip);
1469d4fa1a1SMauro Carvalho Chehab }
1479d4fa1a1SMauro Carvalho Chehab 
1489d4fa1a1SMauro Carvalho Chehab void
ia_css_output_debug_dtrace(const struct ia_css_output_config * config,unsigned int level)1499d4fa1a1SMauro Carvalho Chehab ia_css_output_debug_dtrace(
1509d4fa1a1SMauro Carvalho Chehab     const struct ia_css_output_config *config,
1519d4fa1a1SMauro Carvalho Chehab     unsigned int level)
1529d4fa1a1SMauro Carvalho Chehab {
1539d4fa1a1SMauro Carvalho Chehab 	ia_css_debug_dtrace(level,
1549d4fa1a1SMauro Carvalho Chehab 			    "config.enable_hflip=%d",
1559d4fa1a1SMauro Carvalho Chehab 			    config->enable_hflip);
1569d4fa1a1SMauro Carvalho Chehab 	ia_css_debug_dtrace(level,
1579d4fa1a1SMauro Carvalho Chehab 			    "config.enable_vflip=%d",
1589d4fa1a1SMauro Carvalho Chehab 			    config->enable_vflip);
1599d4fa1a1SMauro Carvalho Chehab }
160