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 * 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/* The name "gdc.h is already taken" */
17#include "gdc_device.h"
18
19#include "device_access.h"
20
21#include "assert_support.h"
22
23/*
24 * Local function declarations
25 */
26static inline void gdc_reg_store(
27    const gdc_ID_t		ID,
28    const unsigned int	reg,
29    const hrt_data		value);
30
31#ifndef __INLINE_GDC__
32#include "gdc_private.h"
33#endif /* __INLINE_GDC__ */
34
35/*
36 * Exported function implementations
37 */
38void gdc_lut_store(
39    const gdc_ID_t		ID,
40    const int			data[4][HRT_GDC_N])
41{
42	unsigned int i, lut_offset = HRT_GDC_LUT_IDX;
43
44	assert(ID < N_GDC_ID);
45	assert(HRT_GDC_LUT_COEFF_OFFSET <= (4 * sizeof(hrt_data)));
46
47	for (i = 0; i < HRT_GDC_N; i++) {
48		hrt_data	entry_0 = data[0][i] & HRT_GDC_BCI_COEF_MASK;
49		hrt_data	entry_1 = data[1][i] & HRT_GDC_BCI_COEF_MASK;
50		hrt_data	entry_2 = data[2][i] & HRT_GDC_BCI_COEF_MASK;
51		hrt_data	entry_3 = data[3][i] & HRT_GDC_BCI_COEF_MASK;
52
53		hrt_data	word_0 = entry_0 |
54				     (entry_1 << HRT_GDC_LUT_COEFF_OFFSET);
55		hrt_data	word_1 = entry_2 |
56				     (entry_3 << HRT_GDC_LUT_COEFF_OFFSET);
57
58		gdc_reg_store(ID, lut_offset++, word_0);
59		gdc_reg_store(ID, lut_offset++, word_1);
60	}
61	return;
62}
63
64/*
65 * Input LUT format:
66 * c0[0-1023], c1[0-1023], c2[0-1023] c3[0-1023]
67 *
68 * Output LUT format (interleaved):
69 * c0[0], c1[0], c2[0], c3[0], c0[1], c1[1], c2[1], c3[1], ....
70 * c0[1023], c1[1023], c2[1023], c3[1023]
71 *
72 * The first format needs c0[0], c1[0] (which are 1024 words apart)
73 * to program gdc LUT registers. This makes it difficult to do piecemeal
74 * reads in SP side gdc_lut_store
75 *
76 * Interleaved format allows use of contiguous bytes to store into
77 * gdc LUT registers.
78 *
79 * See gdc_lut_store() definition in host/gdc.c vs sp/gdc_private.h
80 *
81 */
82void gdc_lut_convert_to_isp_format(const int in_lut[4][HRT_GDC_N],
83				   int out_lut[4][HRT_GDC_N])
84{
85	unsigned int i;
86	int *out = (int *)out_lut;
87
88	for (i = 0; i < HRT_GDC_N; i++) {
89		out[0] = in_lut[0][i];
90		out[1] = in_lut[1][i];
91		out[2] = in_lut[2][i];
92		out[3] = in_lut[3][i];
93		out += 4;
94	}
95}
96
97int gdc_get_unity(
98    const gdc_ID_t		ID)
99{
100	assert(ID < N_GDC_ID);
101	(void)ID;
102	return (int)(1UL << HRT_GDC_FRAC_BITS);
103}
104
105/*
106 * Local function implementations
107 */
108static inline void gdc_reg_store(
109    const gdc_ID_t		ID,
110    const unsigned int	reg,
111    const hrt_data		value)
112{
113	ia_css_device_store_uint32(GDC_BASE[ID] + reg * sizeof(hrt_data), value);
114	return;
115}
116