1*e7b8153eSMauro Carvalho Chehab // SPDX-License-Identifier: GPL-2.0
2*e7b8153eSMauro Carvalho Chehab /*
3*e7b8153eSMauro Carvalho Chehab * Copyright (C) STMicroelectronics SA 2014
4*e7b8153eSMauro Carvalho Chehab * Authors: Fabien Dessenne <fabien.dessenne@st.com> for STMicroelectronics.
5*e7b8153eSMauro Carvalho Chehab */
6*e7b8153eSMauro Carvalho Chehab
7*e7b8153eSMauro Carvalho Chehab #include <linux/delay.h>
8*e7b8153eSMauro Carvalho Chehab
9*e7b8153eSMauro Carvalho Chehab #include "bdisp.h"
10*e7b8153eSMauro Carvalho Chehab #include "bdisp-filter.h"
11*e7b8153eSMauro Carvalho Chehab #include "bdisp-reg.h"
12*e7b8153eSMauro Carvalho Chehab
13*e7b8153eSMauro Carvalho Chehab /* Max width of the source frame in a single node */
14*e7b8153eSMauro Carvalho Chehab #define MAX_SRC_WIDTH 2048
15*e7b8153eSMauro Carvalho Chehab
16*e7b8153eSMauro Carvalho Chehab /* Reset & boot poll config */
17*e7b8153eSMauro Carvalho Chehab #define POLL_RST_MAX 500
18*e7b8153eSMauro Carvalho Chehab #define POLL_RST_DELAY_MS 2
19*e7b8153eSMauro Carvalho Chehab
20*e7b8153eSMauro Carvalho Chehab enum bdisp_target_plan {
21*e7b8153eSMauro Carvalho Chehab BDISP_RGB,
22*e7b8153eSMauro Carvalho Chehab BDISP_Y,
23*e7b8153eSMauro Carvalho Chehab BDISP_CBCR
24*e7b8153eSMauro Carvalho Chehab };
25*e7b8153eSMauro Carvalho Chehab
26*e7b8153eSMauro Carvalho Chehab struct bdisp_op_cfg {
27*e7b8153eSMauro Carvalho Chehab bool cconv; /* RGB - YUV conversion */
28*e7b8153eSMauro Carvalho Chehab bool hflip; /* Horizontal flip */
29*e7b8153eSMauro Carvalho Chehab bool vflip; /* Vertical flip */
30*e7b8153eSMauro Carvalho Chehab bool wide; /* Wide (>MAX_SRC_WIDTH) */
31*e7b8153eSMauro Carvalho Chehab bool scale; /* Scale */
32*e7b8153eSMauro Carvalho Chehab u16 h_inc; /* Horizontal increment in 6.10 format */
33*e7b8153eSMauro Carvalho Chehab u16 v_inc; /* Vertical increment in 6.10 format */
34*e7b8153eSMauro Carvalho Chehab bool src_interlaced; /* is the src an interlaced buffer */
35*e7b8153eSMauro Carvalho Chehab u8 src_nbp; /* nb of planes of the src */
36*e7b8153eSMauro Carvalho Chehab bool src_yuv; /* is the src a YUV color format */
37*e7b8153eSMauro Carvalho Chehab bool src_420; /* is the src 4:2:0 chroma subsampled */
38*e7b8153eSMauro Carvalho Chehab u8 dst_nbp; /* nb of planes of the dst */
39*e7b8153eSMauro Carvalho Chehab bool dst_yuv; /* is the dst a YUV color format */
40*e7b8153eSMauro Carvalho Chehab bool dst_420; /* is the dst 4:2:0 chroma subsampled */
41*e7b8153eSMauro Carvalho Chehab };
42*e7b8153eSMauro Carvalho Chehab
43*e7b8153eSMauro Carvalho Chehab struct bdisp_filter_addr {
44*e7b8153eSMauro Carvalho Chehab u16 min; /* Filter min scale factor (6.10 fixed point) */
45*e7b8153eSMauro Carvalho Chehab u16 max; /* Filter max scale factor (6.10 fixed point) */
46*e7b8153eSMauro Carvalho Chehab void *virt; /* Virtual address for filter table */
47*e7b8153eSMauro Carvalho Chehab dma_addr_t paddr; /* Physical address for filter table */
48*e7b8153eSMauro Carvalho Chehab };
49*e7b8153eSMauro Carvalho Chehab
50*e7b8153eSMauro Carvalho Chehab static const struct bdisp_filter_h_spec bdisp_h_spec[] = {
51*e7b8153eSMauro Carvalho Chehab {
52*e7b8153eSMauro Carvalho Chehab .min = 0,
53*e7b8153eSMauro Carvalho Chehab .max = 921,
54*e7b8153eSMauro Carvalho Chehab .coef = {
55*e7b8153eSMauro Carvalho Chehab 0x00, 0x00, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00,
56*e7b8153eSMauro Carvalho Chehab 0x00, 0x00, 0xff, 0x07, 0x3d, 0xfc, 0x01, 0x00,
57*e7b8153eSMauro Carvalho Chehab 0x00, 0x01, 0xfd, 0x11, 0x36, 0xf9, 0x02, 0x00,
58*e7b8153eSMauro Carvalho Chehab 0x00, 0x01, 0xfb, 0x1b, 0x2e, 0xf9, 0x02, 0x00,
59*e7b8153eSMauro Carvalho Chehab 0x00, 0x01, 0xf9, 0x26, 0x26, 0xf9, 0x01, 0x00,
60*e7b8153eSMauro Carvalho Chehab 0x00, 0x02, 0xf9, 0x30, 0x19, 0xfb, 0x01, 0x00,
61*e7b8153eSMauro Carvalho Chehab 0x00, 0x02, 0xf9, 0x39, 0x0e, 0xfd, 0x01, 0x00,
62*e7b8153eSMauro Carvalho Chehab 0x00, 0x01, 0xfc, 0x3e, 0x06, 0xff, 0x00, 0x00
63*e7b8153eSMauro Carvalho Chehab }
64*e7b8153eSMauro Carvalho Chehab },
65*e7b8153eSMauro Carvalho Chehab {
66*e7b8153eSMauro Carvalho Chehab .min = 921,
67*e7b8153eSMauro Carvalho Chehab .max = 1024,
68*e7b8153eSMauro Carvalho Chehab .coef = {
69*e7b8153eSMauro Carvalho Chehab 0x00, 0x00, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00,
70*e7b8153eSMauro Carvalho Chehab 0xff, 0x03, 0xfd, 0x08, 0x3e, 0xf9, 0x04, 0xfe,
71*e7b8153eSMauro Carvalho Chehab 0xfd, 0x06, 0xf8, 0x13, 0x3b, 0xf4, 0x07, 0xfc,
72*e7b8153eSMauro Carvalho Chehab 0xfb, 0x08, 0xf5, 0x1f, 0x34, 0xf1, 0x09, 0xfb,
73*e7b8153eSMauro Carvalho Chehab 0xfb, 0x09, 0xf2, 0x2b, 0x2a, 0xf1, 0x09, 0xfb,
74*e7b8153eSMauro Carvalho Chehab 0xfb, 0x09, 0xf2, 0x35, 0x1e, 0xf4, 0x08, 0xfb,
75*e7b8153eSMauro Carvalho Chehab 0xfc, 0x07, 0xf5, 0x3c, 0x12, 0xf7, 0x06, 0xfd,
76*e7b8153eSMauro Carvalho Chehab 0xfe, 0x04, 0xfa, 0x3f, 0x07, 0xfc, 0x03, 0xff
77*e7b8153eSMauro Carvalho Chehab }
78*e7b8153eSMauro Carvalho Chehab },
79*e7b8153eSMauro Carvalho Chehab {
80*e7b8153eSMauro Carvalho Chehab .min = 1024,
81*e7b8153eSMauro Carvalho Chehab .max = 1126,
82*e7b8153eSMauro Carvalho Chehab .coef = {
83*e7b8153eSMauro Carvalho Chehab 0x00, 0x00, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00,
84*e7b8153eSMauro Carvalho Chehab 0xff, 0x03, 0xfd, 0x08, 0x3e, 0xf9, 0x04, 0xfe,
85*e7b8153eSMauro Carvalho Chehab 0xfd, 0x06, 0xf8, 0x13, 0x3b, 0xf4, 0x07, 0xfc,
86*e7b8153eSMauro Carvalho Chehab 0xfb, 0x08, 0xf5, 0x1f, 0x34, 0xf1, 0x09, 0xfb,
87*e7b8153eSMauro Carvalho Chehab 0xfb, 0x09, 0xf2, 0x2b, 0x2a, 0xf1, 0x09, 0xfb,
88*e7b8153eSMauro Carvalho Chehab 0xfb, 0x09, 0xf2, 0x35, 0x1e, 0xf4, 0x08, 0xfb,
89*e7b8153eSMauro Carvalho Chehab 0xfc, 0x07, 0xf5, 0x3c, 0x12, 0xf7, 0x06, 0xfd,
90*e7b8153eSMauro Carvalho Chehab 0xfe, 0x04, 0xfa, 0x3f, 0x07, 0xfc, 0x03, 0xff
91*e7b8153eSMauro Carvalho Chehab }
92*e7b8153eSMauro Carvalho Chehab },
93*e7b8153eSMauro Carvalho Chehab {
94*e7b8153eSMauro Carvalho Chehab .min = 1126,
95*e7b8153eSMauro Carvalho Chehab .max = 1228,
96*e7b8153eSMauro Carvalho Chehab .coef = {
97*e7b8153eSMauro Carvalho Chehab 0x00, 0x00, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00,
98*e7b8153eSMauro Carvalho Chehab 0xff, 0x03, 0xfd, 0x08, 0x3e, 0xf9, 0x04, 0xfe,
99*e7b8153eSMauro Carvalho Chehab 0xfd, 0x06, 0xf8, 0x13, 0x3b, 0xf4, 0x07, 0xfc,
100*e7b8153eSMauro Carvalho Chehab 0xfb, 0x08, 0xf5, 0x1f, 0x34, 0xf1, 0x09, 0xfb,
101*e7b8153eSMauro Carvalho Chehab 0xfb, 0x09, 0xf2, 0x2b, 0x2a, 0xf1, 0x09, 0xfb,
102*e7b8153eSMauro Carvalho Chehab 0xfb, 0x09, 0xf2, 0x35, 0x1e, 0xf4, 0x08, 0xfb,
103*e7b8153eSMauro Carvalho Chehab 0xfc, 0x07, 0xf5, 0x3c, 0x12, 0xf7, 0x06, 0xfd,
104*e7b8153eSMauro Carvalho Chehab 0xfe, 0x04, 0xfa, 0x3f, 0x07, 0xfc, 0x03, 0xff
105*e7b8153eSMauro Carvalho Chehab }
106*e7b8153eSMauro Carvalho Chehab },
107*e7b8153eSMauro Carvalho Chehab {
108*e7b8153eSMauro Carvalho Chehab .min = 1228,
109*e7b8153eSMauro Carvalho Chehab .max = 1331,
110*e7b8153eSMauro Carvalho Chehab .coef = {
111*e7b8153eSMauro Carvalho Chehab 0xfd, 0x04, 0xfc, 0x05, 0x39, 0x05, 0xfc, 0x04,
112*e7b8153eSMauro Carvalho Chehab 0xfc, 0x06, 0xf9, 0x0c, 0x39, 0xfe, 0x00, 0x02,
113*e7b8153eSMauro Carvalho Chehab 0xfb, 0x08, 0xf6, 0x17, 0x35, 0xf9, 0x02, 0x00,
114*e7b8153eSMauro Carvalho Chehab 0xfc, 0x08, 0xf4, 0x20, 0x30, 0xf4, 0x05, 0xff,
115*e7b8153eSMauro Carvalho Chehab 0xfd, 0x07, 0xf4, 0x29, 0x28, 0xf3, 0x07, 0xfd,
116*e7b8153eSMauro Carvalho Chehab 0xff, 0x05, 0xf5, 0x31, 0x1f, 0xf3, 0x08, 0xfc,
117*e7b8153eSMauro Carvalho Chehab 0x00, 0x02, 0xf9, 0x38, 0x14, 0xf6, 0x08, 0xfb,
118*e7b8153eSMauro Carvalho Chehab 0x02, 0x00, 0xff, 0x3a, 0x0b, 0xf8, 0x06, 0xfc
119*e7b8153eSMauro Carvalho Chehab }
120*e7b8153eSMauro Carvalho Chehab },
121*e7b8153eSMauro Carvalho Chehab {
122*e7b8153eSMauro Carvalho Chehab .min = 1331,
123*e7b8153eSMauro Carvalho Chehab .max = 1433,
124*e7b8153eSMauro Carvalho Chehab .coef = {
125*e7b8153eSMauro Carvalho Chehab 0xfc, 0x06, 0xf9, 0x09, 0x34, 0x09, 0xf9, 0x06,
126*e7b8153eSMauro Carvalho Chehab 0xfd, 0x07, 0xf7, 0x10, 0x32, 0x02, 0xfc, 0x05,
127*e7b8153eSMauro Carvalho Chehab 0xfe, 0x07, 0xf6, 0x17, 0x2f, 0xfc, 0xff, 0x04,
128*e7b8153eSMauro Carvalho Chehab 0xff, 0x06, 0xf5, 0x20, 0x2a, 0xf9, 0x01, 0x02,
129*e7b8153eSMauro Carvalho Chehab 0x00, 0x04, 0xf6, 0x27, 0x25, 0xf6, 0x04, 0x00,
130*e7b8153eSMauro Carvalho Chehab 0x02, 0x01, 0xf9, 0x2d, 0x1d, 0xf5, 0x06, 0xff,
131*e7b8153eSMauro Carvalho Chehab 0x04, 0xff, 0xfd, 0x31, 0x15, 0xf5, 0x07, 0xfe,
132*e7b8153eSMauro Carvalho Chehab 0x05, 0xfc, 0x02, 0x35, 0x0d, 0xf7, 0x07, 0xfd
133*e7b8153eSMauro Carvalho Chehab }
134*e7b8153eSMauro Carvalho Chehab },
135*e7b8153eSMauro Carvalho Chehab {
136*e7b8153eSMauro Carvalho Chehab .min = 1433,
137*e7b8153eSMauro Carvalho Chehab .max = 1536,
138*e7b8153eSMauro Carvalho Chehab .coef = {
139*e7b8153eSMauro Carvalho Chehab 0xfe, 0x06, 0xf8, 0x0b, 0x30, 0x0b, 0xf8, 0x06,
140*e7b8153eSMauro Carvalho Chehab 0xff, 0x06, 0xf7, 0x12, 0x2d, 0x05, 0xfa, 0x06,
141*e7b8153eSMauro Carvalho Chehab 0x00, 0x04, 0xf6, 0x18, 0x2c, 0x00, 0xfc, 0x06,
142*e7b8153eSMauro Carvalho Chehab 0x01, 0x02, 0xf7, 0x1f, 0x27, 0xfd, 0xff, 0x04,
143*e7b8153eSMauro Carvalho Chehab 0x03, 0x00, 0xf9, 0x24, 0x24, 0xf9, 0x00, 0x03,
144*e7b8153eSMauro Carvalho Chehab 0x04, 0xff, 0xfd, 0x29, 0x1d, 0xf7, 0x02, 0x01,
145*e7b8153eSMauro Carvalho Chehab 0x06, 0xfc, 0x00, 0x2d, 0x17, 0xf6, 0x04, 0x00,
146*e7b8153eSMauro Carvalho Chehab 0x06, 0xfa, 0x05, 0x30, 0x0f, 0xf7, 0x06, 0xff
147*e7b8153eSMauro Carvalho Chehab }
148*e7b8153eSMauro Carvalho Chehab },
149*e7b8153eSMauro Carvalho Chehab {
150*e7b8153eSMauro Carvalho Chehab .min = 1536,
151*e7b8153eSMauro Carvalho Chehab .max = 2048,
152*e7b8153eSMauro Carvalho Chehab .coef = {
153*e7b8153eSMauro Carvalho Chehab 0x05, 0xfd, 0xfb, 0x13, 0x25, 0x13, 0xfb, 0xfd,
154*e7b8153eSMauro Carvalho Chehab 0x05, 0xfc, 0xfd, 0x17, 0x24, 0x0f, 0xf9, 0xff,
155*e7b8153eSMauro Carvalho Chehab 0x04, 0xfa, 0xff, 0x1b, 0x24, 0x0b, 0xf9, 0x00,
156*e7b8153eSMauro Carvalho Chehab 0x03, 0xf9, 0x01, 0x1f, 0x23, 0x08, 0xf8, 0x01,
157*e7b8153eSMauro Carvalho Chehab 0x02, 0xf9, 0x04, 0x22, 0x20, 0x04, 0xf9, 0x02,
158*e7b8153eSMauro Carvalho Chehab 0x01, 0xf8, 0x08, 0x25, 0x1d, 0x01, 0xf9, 0x03,
159*e7b8153eSMauro Carvalho Chehab 0x00, 0xf9, 0x0c, 0x25, 0x1a, 0xfe, 0xfa, 0x04,
160*e7b8153eSMauro Carvalho Chehab 0xff, 0xf9, 0x10, 0x26, 0x15, 0xfc, 0xfc, 0x05
161*e7b8153eSMauro Carvalho Chehab }
162*e7b8153eSMauro Carvalho Chehab },
163*e7b8153eSMauro Carvalho Chehab {
164*e7b8153eSMauro Carvalho Chehab .min = 2048,
165*e7b8153eSMauro Carvalho Chehab .max = 3072,
166*e7b8153eSMauro Carvalho Chehab .coef = {
167*e7b8153eSMauro Carvalho Chehab 0xfc, 0xfd, 0x06, 0x13, 0x18, 0x13, 0x06, 0xfd,
168*e7b8153eSMauro Carvalho Chehab 0xfc, 0xfe, 0x08, 0x15, 0x17, 0x12, 0x04, 0xfc,
169*e7b8153eSMauro Carvalho Chehab 0xfb, 0xfe, 0x0a, 0x16, 0x18, 0x10, 0x03, 0xfc,
170*e7b8153eSMauro Carvalho Chehab 0xfb, 0x00, 0x0b, 0x18, 0x17, 0x0f, 0x01, 0xfb,
171*e7b8153eSMauro Carvalho Chehab 0xfb, 0x00, 0x0d, 0x19, 0x17, 0x0d, 0x00, 0xfb,
172*e7b8153eSMauro Carvalho Chehab 0xfb, 0x01, 0x0f, 0x19, 0x16, 0x0b, 0x00, 0xfb,
173*e7b8153eSMauro Carvalho Chehab 0xfc, 0x03, 0x11, 0x19, 0x15, 0x09, 0xfe, 0xfb,
174*e7b8153eSMauro Carvalho Chehab 0xfc, 0x04, 0x12, 0x1a, 0x12, 0x08, 0xfe, 0xfc
175*e7b8153eSMauro Carvalho Chehab }
176*e7b8153eSMauro Carvalho Chehab },
177*e7b8153eSMauro Carvalho Chehab {
178*e7b8153eSMauro Carvalho Chehab .min = 3072,
179*e7b8153eSMauro Carvalho Chehab .max = 4096,
180*e7b8153eSMauro Carvalho Chehab .coef = {
181*e7b8153eSMauro Carvalho Chehab 0xfe, 0x02, 0x09, 0x0f, 0x0e, 0x0f, 0x09, 0x02,
182*e7b8153eSMauro Carvalho Chehab 0xff, 0x02, 0x09, 0x0f, 0x10, 0x0e, 0x08, 0x01,
183*e7b8153eSMauro Carvalho Chehab 0xff, 0x03, 0x0a, 0x10, 0x10, 0x0d, 0x07, 0x00,
184*e7b8153eSMauro Carvalho Chehab 0x00, 0x04, 0x0b, 0x10, 0x0f, 0x0c, 0x06, 0x00,
185*e7b8153eSMauro Carvalho Chehab 0x00, 0x05, 0x0c, 0x10, 0x0e, 0x0c, 0x05, 0x00,
186*e7b8153eSMauro Carvalho Chehab 0x00, 0x06, 0x0c, 0x11, 0x0e, 0x0b, 0x04, 0x00,
187*e7b8153eSMauro Carvalho Chehab 0x00, 0x07, 0x0d, 0x11, 0x0f, 0x0a, 0x03, 0xff,
188*e7b8153eSMauro Carvalho Chehab 0x01, 0x08, 0x0e, 0x11, 0x0e, 0x09, 0x02, 0xff
189*e7b8153eSMauro Carvalho Chehab }
190*e7b8153eSMauro Carvalho Chehab },
191*e7b8153eSMauro Carvalho Chehab {
192*e7b8153eSMauro Carvalho Chehab .min = 4096,
193*e7b8153eSMauro Carvalho Chehab .max = 5120,
194*e7b8153eSMauro Carvalho Chehab .coef = {
195*e7b8153eSMauro Carvalho Chehab 0x00, 0x04, 0x09, 0x0c, 0x0e, 0x0c, 0x09, 0x04,
196*e7b8153eSMauro Carvalho Chehab 0x01, 0x05, 0x09, 0x0c, 0x0d, 0x0c, 0x08, 0x04,
197*e7b8153eSMauro Carvalho Chehab 0x01, 0x05, 0x0a, 0x0c, 0x0e, 0x0b, 0x08, 0x03,
198*e7b8153eSMauro Carvalho Chehab 0x02, 0x06, 0x0a, 0x0d, 0x0c, 0x0b, 0x07, 0x03,
199*e7b8153eSMauro Carvalho Chehab 0x02, 0x07, 0x0a, 0x0d, 0x0d, 0x0a, 0x07, 0x02,
200*e7b8153eSMauro Carvalho Chehab 0x03, 0x07, 0x0b, 0x0d, 0x0c, 0x0a, 0x06, 0x02,
201*e7b8153eSMauro Carvalho Chehab 0x03, 0x08, 0x0b, 0x0d, 0x0d, 0x0a, 0x05, 0x01,
202*e7b8153eSMauro Carvalho Chehab 0x04, 0x08, 0x0c, 0x0d, 0x0c, 0x09, 0x05, 0x01
203*e7b8153eSMauro Carvalho Chehab }
204*e7b8153eSMauro Carvalho Chehab },
205*e7b8153eSMauro Carvalho Chehab {
206*e7b8153eSMauro Carvalho Chehab .min = 5120,
207*e7b8153eSMauro Carvalho Chehab .max = 65535,
208*e7b8153eSMauro Carvalho Chehab .coef = {
209*e7b8153eSMauro Carvalho Chehab 0x03, 0x06, 0x09, 0x0b, 0x09, 0x0b, 0x09, 0x06,
210*e7b8153eSMauro Carvalho Chehab 0x03, 0x06, 0x09, 0x0b, 0x0c, 0x0a, 0x08, 0x05,
211*e7b8153eSMauro Carvalho Chehab 0x03, 0x06, 0x09, 0x0b, 0x0c, 0x0a, 0x08, 0x05,
212*e7b8153eSMauro Carvalho Chehab 0x04, 0x07, 0x09, 0x0b, 0x0b, 0x0a, 0x08, 0x04,
213*e7b8153eSMauro Carvalho Chehab 0x04, 0x07, 0x0a, 0x0b, 0x0b, 0x0a, 0x07, 0x04,
214*e7b8153eSMauro Carvalho Chehab 0x04, 0x08, 0x0a, 0x0b, 0x0b, 0x09, 0x07, 0x04,
215*e7b8153eSMauro Carvalho Chehab 0x05, 0x08, 0x0a, 0x0b, 0x0c, 0x09, 0x06, 0x03,
216*e7b8153eSMauro Carvalho Chehab 0x05, 0x08, 0x0a, 0x0b, 0x0c, 0x09, 0x06, 0x03
217*e7b8153eSMauro Carvalho Chehab }
218*e7b8153eSMauro Carvalho Chehab }
219*e7b8153eSMauro Carvalho Chehab };
220*e7b8153eSMauro Carvalho Chehab
221*e7b8153eSMauro Carvalho Chehab #define NB_H_FILTER ARRAY_SIZE(bdisp_h_spec)
222*e7b8153eSMauro Carvalho Chehab
223*e7b8153eSMauro Carvalho Chehab
224*e7b8153eSMauro Carvalho Chehab static const struct bdisp_filter_v_spec bdisp_v_spec[] = {
225*e7b8153eSMauro Carvalho Chehab {
226*e7b8153eSMauro Carvalho Chehab .min = 0,
227*e7b8153eSMauro Carvalho Chehab .max = 1024,
228*e7b8153eSMauro Carvalho Chehab .coef = {
229*e7b8153eSMauro Carvalho Chehab 0x00, 0x00, 0x40, 0x00, 0x00,
230*e7b8153eSMauro Carvalho Chehab 0x00, 0x06, 0x3d, 0xfd, 0x00,
231*e7b8153eSMauro Carvalho Chehab 0xfe, 0x0f, 0x38, 0xfb, 0x00,
232*e7b8153eSMauro Carvalho Chehab 0xfd, 0x19, 0x2f, 0xfb, 0x00,
233*e7b8153eSMauro Carvalho Chehab 0xfc, 0x24, 0x24, 0xfc, 0x00,
234*e7b8153eSMauro Carvalho Chehab 0xfb, 0x2f, 0x19, 0xfd, 0x00,
235*e7b8153eSMauro Carvalho Chehab 0xfb, 0x38, 0x0f, 0xfe, 0x00,
236*e7b8153eSMauro Carvalho Chehab 0xfd, 0x3d, 0x06, 0x00, 0x00
237*e7b8153eSMauro Carvalho Chehab }
238*e7b8153eSMauro Carvalho Chehab },
239*e7b8153eSMauro Carvalho Chehab {
240*e7b8153eSMauro Carvalho Chehab .min = 1024,
241*e7b8153eSMauro Carvalho Chehab .max = 1331,
242*e7b8153eSMauro Carvalho Chehab .coef = {
243*e7b8153eSMauro Carvalho Chehab 0xfc, 0x05, 0x3e, 0x05, 0xfc,
244*e7b8153eSMauro Carvalho Chehab 0xf8, 0x0e, 0x3b, 0xff, 0x00,
245*e7b8153eSMauro Carvalho Chehab 0xf5, 0x18, 0x38, 0xf9, 0x02,
246*e7b8153eSMauro Carvalho Chehab 0xf4, 0x21, 0x31, 0xf5, 0x05,
247*e7b8153eSMauro Carvalho Chehab 0xf4, 0x2a, 0x27, 0xf4, 0x07,
248*e7b8153eSMauro Carvalho Chehab 0xf6, 0x30, 0x1e, 0xf4, 0x08,
249*e7b8153eSMauro Carvalho Chehab 0xf9, 0x35, 0x15, 0xf6, 0x07,
250*e7b8153eSMauro Carvalho Chehab 0xff, 0x37, 0x0b, 0xf9, 0x06
251*e7b8153eSMauro Carvalho Chehab }
252*e7b8153eSMauro Carvalho Chehab },
253*e7b8153eSMauro Carvalho Chehab {
254*e7b8153eSMauro Carvalho Chehab .min = 1331,
255*e7b8153eSMauro Carvalho Chehab .max = 1433,
256*e7b8153eSMauro Carvalho Chehab .coef = {
257*e7b8153eSMauro Carvalho Chehab 0xf8, 0x0a, 0x3c, 0x0a, 0xf8,
258*e7b8153eSMauro Carvalho Chehab 0xf6, 0x12, 0x3b, 0x02, 0xfb,
259*e7b8153eSMauro Carvalho Chehab 0xf4, 0x1b, 0x35, 0xfd, 0xff,
260*e7b8153eSMauro Carvalho Chehab 0xf4, 0x23, 0x30, 0xf8, 0x01,
261*e7b8153eSMauro Carvalho Chehab 0xf6, 0x29, 0x27, 0xf6, 0x04,
262*e7b8153eSMauro Carvalho Chehab 0xf9, 0x2e, 0x1e, 0xf5, 0x06,
263*e7b8153eSMauro Carvalho Chehab 0xfd, 0x31, 0x16, 0xf6, 0x06,
264*e7b8153eSMauro Carvalho Chehab 0x02, 0x32, 0x0d, 0xf8, 0x07
265*e7b8153eSMauro Carvalho Chehab }
266*e7b8153eSMauro Carvalho Chehab },
267*e7b8153eSMauro Carvalho Chehab {
268*e7b8153eSMauro Carvalho Chehab .min = 1433,
269*e7b8153eSMauro Carvalho Chehab .max = 1536,
270*e7b8153eSMauro Carvalho Chehab .coef = {
271*e7b8153eSMauro Carvalho Chehab 0xf6, 0x0e, 0x38, 0x0e, 0xf6,
272*e7b8153eSMauro Carvalho Chehab 0xf5, 0x15, 0x38, 0x06, 0xf8,
273*e7b8153eSMauro Carvalho Chehab 0xf5, 0x1d, 0x33, 0x00, 0xfb,
274*e7b8153eSMauro Carvalho Chehab 0xf6, 0x23, 0x2d, 0xfc, 0xfe,
275*e7b8153eSMauro Carvalho Chehab 0xf9, 0x28, 0x26, 0xf9, 0x00,
276*e7b8153eSMauro Carvalho Chehab 0xfc, 0x2c, 0x1e, 0xf7, 0x03,
277*e7b8153eSMauro Carvalho Chehab 0x00, 0x2e, 0x18, 0xf6, 0x04,
278*e7b8153eSMauro Carvalho Chehab 0x05, 0x2e, 0x11, 0xf7, 0x05
279*e7b8153eSMauro Carvalho Chehab }
280*e7b8153eSMauro Carvalho Chehab },
281*e7b8153eSMauro Carvalho Chehab {
282*e7b8153eSMauro Carvalho Chehab .min = 1536,
283*e7b8153eSMauro Carvalho Chehab .max = 2048,
284*e7b8153eSMauro Carvalho Chehab .coef = {
285*e7b8153eSMauro Carvalho Chehab 0xfb, 0x13, 0x24, 0x13, 0xfb,
286*e7b8153eSMauro Carvalho Chehab 0xfd, 0x17, 0x23, 0x0f, 0xfa,
287*e7b8153eSMauro Carvalho Chehab 0xff, 0x1a, 0x23, 0x0b, 0xf9,
288*e7b8153eSMauro Carvalho Chehab 0x01, 0x1d, 0x22, 0x07, 0xf9,
289*e7b8153eSMauro Carvalho Chehab 0x04, 0x20, 0x1f, 0x04, 0xf9,
290*e7b8153eSMauro Carvalho Chehab 0x07, 0x22, 0x1c, 0x01, 0xfa,
291*e7b8153eSMauro Carvalho Chehab 0x0b, 0x24, 0x17, 0xff, 0xfb,
292*e7b8153eSMauro Carvalho Chehab 0x0f, 0x24, 0x14, 0xfd, 0xfc
293*e7b8153eSMauro Carvalho Chehab }
294*e7b8153eSMauro Carvalho Chehab },
295*e7b8153eSMauro Carvalho Chehab {
296*e7b8153eSMauro Carvalho Chehab .min = 2048,
297*e7b8153eSMauro Carvalho Chehab .max = 3072,
298*e7b8153eSMauro Carvalho Chehab .coef = {
299*e7b8153eSMauro Carvalho Chehab 0x05, 0x10, 0x16, 0x10, 0x05,
300*e7b8153eSMauro Carvalho Chehab 0x06, 0x11, 0x16, 0x0f, 0x04,
301*e7b8153eSMauro Carvalho Chehab 0x08, 0x13, 0x15, 0x0e, 0x02,
302*e7b8153eSMauro Carvalho Chehab 0x09, 0x14, 0x16, 0x0c, 0x01,
303*e7b8153eSMauro Carvalho Chehab 0x0b, 0x15, 0x15, 0x0b, 0x00,
304*e7b8153eSMauro Carvalho Chehab 0x0d, 0x16, 0x13, 0x0a, 0x00,
305*e7b8153eSMauro Carvalho Chehab 0x0f, 0x17, 0x13, 0x08, 0xff,
306*e7b8153eSMauro Carvalho Chehab 0x11, 0x18, 0x12, 0x07, 0xfe
307*e7b8153eSMauro Carvalho Chehab }
308*e7b8153eSMauro Carvalho Chehab },
309*e7b8153eSMauro Carvalho Chehab {
310*e7b8153eSMauro Carvalho Chehab .min = 3072,
311*e7b8153eSMauro Carvalho Chehab .max = 4096,
312*e7b8153eSMauro Carvalho Chehab .coef = {
313*e7b8153eSMauro Carvalho Chehab 0x09, 0x0f, 0x10, 0x0f, 0x09,
314*e7b8153eSMauro Carvalho Chehab 0x09, 0x0f, 0x12, 0x0e, 0x08,
315*e7b8153eSMauro Carvalho Chehab 0x0a, 0x10, 0x11, 0x0e, 0x07,
316*e7b8153eSMauro Carvalho Chehab 0x0b, 0x11, 0x11, 0x0d, 0x06,
317*e7b8153eSMauro Carvalho Chehab 0x0c, 0x11, 0x12, 0x0c, 0x05,
318*e7b8153eSMauro Carvalho Chehab 0x0d, 0x12, 0x11, 0x0c, 0x04,
319*e7b8153eSMauro Carvalho Chehab 0x0e, 0x12, 0x11, 0x0b, 0x04,
320*e7b8153eSMauro Carvalho Chehab 0x0f, 0x13, 0x11, 0x0a, 0x03
321*e7b8153eSMauro Carvalho Chehab }
322*e7b8153eSMauro Carvalho Chehab },
323*e7b8153eSMauro Carvalho Chehab {
324*e7b8153eSMauro Carvalho Chehab .min = 4096,
325*e7b8153eSMauro Carvalho Chehab .max = 5120,
326*e7b8153eSMauro Carvalho Chehab .coef = {
327*e7b8153eSMauro Carvalho Chehab 0x0a, 0x0e, 0x10, 0x0e, 0x0a,
328*e7b8153eSMauro Carvalho Chehab 0x0b, 0x0e, 0x0f, 0x0e, 0x0a,
329*e7b8153eSMauro Carvalho Chehab 0x0b, 0x0f, 0x10, 0x0d, 0x09,
330*e7b8153eSMauro Carvalho Chehab 0x0c, 0x0f, 0x10, 0x0d, 0x08,
331*e7b8153eSMauro Carvalho Chehab 0x0d, 0x0f, 0x0f, 0x0d, 0x08,
332*e7b8153eSMauro Carvalho Chehab 0x0d, 0x10, 0x10, 0x0c, 0x07,
333*e7b8153eSMauro Carvalho Chehab 0x0e, 0x10, 0x0f, 0x0c, 0x07,
334*e7b8153eSMauro Carvalho Chehab 0x0f, 0x10, 0x10, 0x0b, 0x06
335*e7b8153eSMauro Carvalho Chehab }
336*e7b8153eSMauro Carvalho Chehab },
337*e7b8153eSMauro Carvalho Chehab {
338*e7b8153eSMauro Carvalho Chehab .min = 5120,
339*e7b8153eSMauro Carvalho Chehab .max = 65535,
340*e7b8153eSMauro Carvalho Chehab .coef = {
341*e7b8153eSMauro Carvalho Chehab 0x0b, 0x0e, 0x0e, 0x0e, 0x0b,
342*e7b8153eSMauro Carvalho Chehab 0x0b, 0x0e, 0x0f, 0x0d, 0x0b,
343*e7b8153eSMauro Carvalho Chehab 0x0c, 0x0e, 0x0f, 0x0d, 0x0a,
344*e7b8153eSMauro Carvalho Chehab 0x0c, 0x0e, 0x0f, 0x0d, 0x0a,
345*e7b8153eSMauro Carvalho Chehab 0x0d, 0x0f, 0x0e, 0x0d, 0x09,
346*e7b8153eSMauro Carvalho Chehab 0x0d, 0x0f, 0x0f, 0x0c, 0x09,
347*e7b8153eSMauro Carvalho Chehab 0x0e, 0x0f, 0x0e, 0x0c, 0x09,
348*e7b8153eSMauro Carvalho Chehab 0x0e, 0x0f, 0x0f, 0x0c, 0x08
349*e7b8153eSMauro Carvalho Chehab }
350*e7b8153eSMauro Carvalho Chehab }
351*e7b8153eSMauro Carvalho Chehab };
352*e7b8153eSMauro Carvalho Chehab
353*e7b8153eSMauro Carvalho Chehab #define NB_V_FILTER ARRAY_SIZE(bdisp_v_spec)
354*e7b8153eSMauro Carvalho Chehab
355*e7b8153eSMauro Carvalho Chehab static struct bdisp_filter_addr bdisp_h_filter[NB_H_FILTER];
356*e7b8153eSMauro Carvalho Chehab static struct bdisp_filter_addr bdisp_v_filter[NB_V_FILTER];
357*e7b8153eSMauro Carvalho Chehab
358*e7b8153eSMauro Carvalho Chehab /**
359*e7b8153eSMauro Carvalho Chehab * bdisp_hw_reset
360*e7b8153eSMauro Carvalho Chehab * @bdisp: bdisp entity
361*e7b8153eSMauro Carvalho Chehab *
362*e7b8153eSMauro Carvalho Chehab * Resets HW
363*e7b8153eSMauro Carvalho Chehab *
364*e7b8153eSMauro Carvalho Chehab * RETURNS:
365*e7b8153eSMauro Carvalho Chehab * 0 on success.
366*e7b8153eSMauro Carvalho Chehab */
bdisp_hw_reset(struct bdisp_dev * bdisp)367*e7b8153eSMauro Carvalho Chehab int bdisp_hw_reset(struct bdisp_dev *bdisp)
368*e7b8153eSMauro Carvalho Chehab {
369*e7b8153eSMauro Carvalho Chehab unsigned int i;
370*e7b8153eSMauro Carvalho Chehab
371*e7b8153eSMauro Carvalho Chehab dev_dbg(bdisp->dev, "%s\n", __func__);
372*e7b8153eSMauro Carvalho Chehab
373*e7b8153eSMauro Carvalho Chehab /* Mask Interrupt */
374*e7b8153eSMauro Carvalho Chehab writel(0, bdisp->regs + BLT_ITM0);
375*e7b8153eSMauro Carvalho Chehab
376*e7b8153eSMauro Carvalho Chehab /* Reset */
377*e7b8153eSMauro Carvalho Chehab writel(readl(bdisp->regs + BLT_CTL) | BLT_CTL_RESET,
378*e7b8153eSMauro Carvalho Chehab bdisp->regs + BLT_CTL);
379*e7b8153eSMauro Carvalho Chehab writel(0, bdisp->regs + BLT_CTL);
380*e7b8153eSMauro Carvalho Chehab
381*e7b8153eSMauro Carvalho Chehab /* Wait for reset done */
382*e7b8153eSMauro Carvalho Chehab for (i = 0; i < POLL_RST_MAX; i++) {
383*e7b8153eSMauro Carvalho Chehab if (readl(bdisp->regs + BLT_STA1) & BLT_STA1_IDLE)
384*e7b8153eSMauro Carvalho Chehab break;
385*e7b8153eSMauro Carvalho Chehab udelay(POLL_RST_DELAY_MS * 1000);
386*e7b8153eSMauro Carvalho Chehab }
387*e7b8153eSMauro Carvalho Chehab if (i == POLL_RST_MAX)
388*e7b8153eSMauro Carvalho Chehab dev_err(bdisp->dev, "Reset timeout\n");
389*e7b8153eSMauro Carvalho Chehab
390*e7b8153eSMauro Carvalho Chehab return (i == POLL_RST_MAX) ? -EAGAIN : 0;
391*e7b8153eSMauro Carvalho Chehab }
392*e7b8153eSMauro Carvalho Chehab
393*e7b8153eSMauro Carvalho Chehab /**
394*e7b8153eSMauro Carvalho Chehab * bdisp_hw_get_and_clear_irq
395*e7b8153eSMauro Carvalho Chehab * @bdisp: bdisp entity
396*e7b8153eSMauro Carvalho Chehab *
397*e7b8153eSMauro Carvalho Chehab * Read then reset interrupt status
398*e7b8153eSMauro Carvalho Chehab *
399*e7b8153eSMauro Carvalho Chehab * RETURNS:
400*e7b8153eSMauro Carvalho Chehab * 0 if expected interrupt was raised.
401*e7b8153eSMauro Carvalho Chehab */
bdisp_hw_get_and_clear_irq(struct bdisp_dev * bdisp)402*e7b8153eSMauro Carvalho Chehab int bdisp_hw_get_and_clear_irq(struct bdisp_dev *bdisp)
403*e7b8153eSMauro Carvalho Chehab {
404*e7b8153eSMauro Carvalho Chehab u32 its;
405*e7b8153eSMauro Carvalho Chehab
406*e7b8153eSMauro Carvalho Chehab its = readl(bdisp->regs + BLT_ITS);
407*e7b8153eSMauro Carvalho Chehab
408*e7b8153eSMauro Carvalho Chehab /* Check for the only expected IT: LastNode of AQ1 */
409*e7b8153eSMauro Carvalho Chehab if (!(its & BLT_ITS_AQ1_LNA)) {
410*e7b8153eSMauro Carvalho Chehab dev_dbg(bdisp->dev, "Unexpected IT status: 0x%08X\n", its);
411*e7b8153eSMauro Carvalho Chehab writel(its, bdisp->regs + BLT_ITS);
412*e7b8153eSMauro Carvalho Chehab return -1;
413*e7b8153eSMauro Carvalho Chehab }
414*e7b8153eSMauro Carvalho Chehab
415*e7b8153eSMauro Carvalho Chehab /* Clear and mask */
416*e7b8153eSMauro Carvalho Chehab writel(its, bdisp->regs + BLT_ITS);
417*e7b8153eSMauro Carvalho Chehab writel(0, bdisp->regs + BLT_ITM0);
418*e7b8153eSMauro Carvalho Chehab
419*e7b8153eSMauro Carvalho Chehab return 0;
420*e7b8153eSMauro Carvalho Chehab }
421*e7b8153eSMauro Carvalho Chehab
422*e7b8153eSMauro Carvalho Chehab /**
423*e7b8153eSMauro Carvalho Chehab * bdisp_hw_free_nodes
424*e7b8153eSMauro Carvalho Chehab * @ctx: bdisp context
425*e7b8153eSMauro Carvalho Chehab *
426*e7b8153eSMauro Carvalho Chehab * Free node memory
427*e7b8153eSMauro Carvalho Chehab *
428*e7b8153eSMauro Carvalho Chehab * RETURNS:
429*e7b8153eSMauro Carvalho Chehab * None
430*e7b8153eSMauro Carvalho Chehab */
bdisp_hw_free_nodes(struct bdisp_ctx * ctx)431*e7b8153eSMauro Carvalho Chehab void bdisp_hw_free_nodes(struct bdisp_ctx *ctx)
432*e7b8153eSMauro Carvalho Chehab {
433*e7b8153eSMauro Carvalho Chehab if (ctx && ctx->node[0])
434*e7b8153eSMauro Carvalho Chehab dma_free_attrs(ctx->bdisp_dev->dev,
435*e7b8153eSMauro Carvalho Chehab sizeof(struct bdisp_node) * MAX_NB_NODE,
436*e7b8153eSMauro Carvalho Chehab ctx->node[0], ctx->node_paddr[0],
437*e7b8153eSMauro Carvalho Chehab DMA_ATTR_WRITE_COMBINE);
438*e7b8153eSMauro Carvalho Chehab }
439*e7b8153eSMauro Carvalho Chehab
440*e7b8153eSMauro Carvalho Chehab /**
441*e7b8153eSMauro Carvalho Chehab * bdisp_hw_alloc_nodes
442*e7b8153eSMauro Carvalho Chehab * @ctx: bdisp context
443*e7b8153eSMauro Carvalho Chehab *
444*e7b8153eSMauro Carvalho Chehab * Allocate dma memory for nodes
445*e7b8153eSMauro Carvalho Chehab *
446*e7b8153eSMauro Carvalho Chehab * RETURNS:
447*e7b8153eSMauro Carvalho Chehab * 0 on success
448*e7b8153eSMauro Carvalho Chehab */
bdisp_hw_alloc_nodes(struct bdisp_ctx * ctx)449*e7b8153eSMauro Carvalho Chehab int bdisp_hw_alloc_nodes(struct bdisp_ctx *ctx)
450*e7b8153eSMauro Carvalho Chehab {
451*e7b8153eSMauro Carvalho Chehab struct device *dev = ctx->bdisp_dev->dev;
452*e7b8153eSMauro Carvalho Chehab unsigned int i, node_size = sizeof(struct bdisp_node);
453*e7b8153eSMauro Carvalho Chehab void *base;
454*e7b8153eSMauro Carvalho Chehab dma_addr_t paddr;
455*e7b8153eSMauro Carvalho Chehab
456*e7b8153eSMauro Carvalho Chehab /* Allocate all the nodes within a single memory page */
457*e7b8153eSMauro Carvalho Chehab base = dma_alloc_attrs(dev, node_size * MAX_NB_NODE, &paddr,
458*e7b8153eSMauro Carvalho Chehab GFP_KERNEL, DMA_ATTR_WRITE_COMBINE);
459*e7b8153eSMauro Carvalho Chehab if (!base) {
460*e7b8153eSMauro Carvalho Chehab dev_err(dev, "%s no mem\n", __func__);
461*e7b8153eSMauro Carvalho Chehab return -ENOMEM;
462*e7b8153eSMauro Carvalho Chehab }
463*e7b8153eSMauro Carvalho Chehab
464*e7b8153eSMauro Carvalho Chehab memset(base, 0, node_size * MAX_NB_NODE);
465*e7b8153eSMauro Carvalho Chehab
466*e7b8153eSMauro Carvalho Chehab for (i = 0; i < MAX_NB_NODE; i++) {
467*e7b8153eSMauro Carvalho Chehab ctx->node[i] = base;
468*e7b8153eSMauro Carvalho Chehab ctx->node_paddr[i] = paddr;
469*e7b8153eSMauro Carvalho Chehab dev_dbg(dev, "node[%d]=0x%p (paddr=%pad)\n", i, ctx->node[i],
470*e7b8153eSMauro Carvalho Chehab &paddr);
471*e7b8153eSMauro Carvalho Chehab base += node_size;
472*e7b8153eSMauro Carvalho Chehab paddr += node_size;
473*e7b8153eSMauro Carvalho Chehab }
474*e7b8153eSMauro Carvalho Chehab
475*e7b8153eSMauro Carvalho Chehab return 0;
476*e7b8153eSMauro Carvalho Chehab }
477*e7b8153eSMauro Carvalho Chehab
478*e7b8153eSMauro Carvalho Chehab /**
479*e7b8153eSMauro Carvalho Chehab * bdisp_hw_free_filters
480*e7b8153eSMauro Carvalho Chehab * @dev: device
481*e7b8153eSMauro Carvalho Chehab *
482*e7b8153eSMauro Carvalho Chehab * Free filters memory
483*e7b8153eSMauro Carvalho Chehab *
484*e7b8153eSMauro Carvalho Chehab * RETURNS:
485*e7b8153eSMauro Carvalho Chehab * None
486*e7b8153eSMauro Carvalho Chehab */
bdisp_hw_free_filters(struct device * dev)487*e7b8153eSMauro Carvalho Chehab void bdisp_hw_free_filters(struct device *dev)
488*e7b8153eSMauro Carvalho Chehab {
489*e7b8153eSMauro Carvalho Chehab int size = (BDISP_HF_NB * NB_H_FILTER) + (BDISP_VF_NB * NB_V_FILTER);
490*e7b8153eSMauro Carvalho Chehab
491*e7b8153eSMauro Carvalho Chehab if (bdisp_h_filter[0].virt)
492*e7b8153eSMauro Carvalho Chehab dma_free_attrs(dev, size, bdisp_h_filter[0].virt,
493*e7b8153eSMauro Carvalho Chehab bdisp_h_filter[0].paddr, DMA_ATTR_WRITE_COMBINE);
494*e7b8153eSMauro Carvalho Chehab }
495*e7b8153eSMauro Carvalho Chehab
496*e7b8153eSMauro Carvalho Chehab /**
497*e7b8153eSMauro Carvalho Chehab * bdisp_hw_alloc_filters
498*e7b8153eSMauro Carvalho Chehab * @dev: device
499*e7b8153eSMauro Carvalho Chehab *
500*e7b8153eSMauro Carvalho Chehab * Allocate dma memory for filters
501*e7b8153eSMauro Carvalho Chehab *
502*e7b8153eSMauro Carvalho Chehab * RETURNS:
503*e7b8153eSMauro Carvalho Chehab * 0 on success
504*e7b8153eSMauro Carvalho Chehab */
bdisp_hw_alloc_filters(struct device * dev)505*e7b8153eSMauro Carvalho Chehab int bdisp_hw_alloc_filters(struct device *dev)
506*e7b8153eSMauro Carvalho Chehab {
507*e7b8153eSMauro Carvalho Chehab unsigned int i, size;
508*e7b8153eSMauro Carvalho Chehab void *base;
509*e7b8153eSMauro Carvalho Chehab dma_addr_t paddr;
510*e7b8153eSMauro Carvalho Chehab
511*e7b8153eSMauro Carvalho Chehab /* Allocate all the filters within a single memory page */
512*e7b8153eSMauro Carvalho Chehab size = (BDISP_HF_NB * NB_H_FILTER) + (BDISP_VF_NB * NB_V_FILTER);
513*e7b8153eSMauro Carvalho Chehab base = dma_alloc_attrs(dev, size, &paddr, GFP_KERNEL,
514*e7b8153eSMauro Carvalho Chehab DMA_ATTR_WRITE_COMBINE);
515*e7b8153eSMauro Carvalho Chehab if (!base)
516*e7b8153eSMauro Carvalho Chehab return -ENOMEM;
517*e7b8153eSMauro Carvalho Chehab
518*e7b8153eSMauro Carvalho Chehab /* Setup filter addresses */
519*e7b8153eSMauro Carvalho Chehab for (i = 0; i < NB_H_FILTER; i++) {
520*e7b8153eSMauro Carvalho Chehab bdisp_h_filter[i].min = bdisp_h_spec[i].min;
521*e7b8153eSMauro Carvalho Chehab bdisp_h_filter[i].max = bdisp_h_spec[i].max;
522*e7b8153eSMauro Carvalho Chehab memcpy(base, bdisp_h_spec[i].coef, BDISP_HF_NB);
523*e7b8153eSMauro Carvalho Chehab bdisp_h_filter[i].virt = base;
524*e7b8153eSMauro Carvalho Chehab bdisp_h_filter[i].paddr = paddr;
525*e7b8153eSMauro Carvalho Chehab base += BDISP_HF_NB;
526*e7b8153eSMauro Carvalho Chehab paddr += BDISP_HF_NB;
527*e7b8153eSMauro Carvalho Chehab }
528*e7b8153eSMauro Carvalho Chehab
529*e7b8153eSMauro Carvalho Chehab for (i = 0; i < NB_V_FILTER; i++) {
530*e7b8153eSMauro Carvalho Chehab bdisp_v_filter[i].min = bdisp_v_spec[i].min;
531*e7b8153eSMauro Carvalho Chehab bdisp_v_filter[i].max = bdisp_v_spec[i].max;
532*e7b8153eSMauro Carvalho Chehab memcpy(base, bdisp_v_spec[i].coef, BDISP_VF_NB);
533*e7b8153eSMauro Carvalho Chehab bdisp_v_filter[i].virt = base;
534*e7b8153eSMauro Carvalho Chehab bdisp_v_filter[i].paddr = paddr;
535*e7b8153eSMauro Carvalho Chehab base += BDISP_VF_NB;
536*e7b8153eSMauro Carvalho Chehab paddr += BDISP_VF_NB;
537*e7b8153eSMauro Carvalho Chehab }
538*e7b8153eSMauro Carvalho Chehab
539*e7b8153eSMauro Carvalho Chehab return 0;
540*e7b8153eSMauro Carvalho Chehab }
541*e7b8153eSMauro Carvalho Chehab
542*e7b8153eSMauro Carvalho Chehab /**
543*e7b8153eSMauro Carvalho Chehab * bdisp_hw_get_hf_addr
544*e7b8153eSMauro Carvalho Chehab * @inc: resize increment
545*e7b8153eSMauro Carvalho Chehab *
546*e7b8153eSMauro Carvalho Chehab * Find the horizontal filter table that fits the resize increment
547*e7b8153eSMauro Carvalho Chehab *
548*e7b8153eSMauro Carvalho Chehab * RETURNS:
549*e7b8153eSMauro Carvalho Chehab * table physical address
550*e7b8153eSMauro Carvalho Chehab */
bdisp_hw_get_hf_addr(u16 inc)551*e7b8153eSMauro Carvalho Chehab static dma_addr_t bdisp_hw_get_hf_addr(u16 inc)
552*e7b8153eSMauro Carvalho Chehab {
553*e7b8153eSMauro Carvalho Chehab unsigned int i;
554*e7b8153eSMauro Carvalho Chehab
555*e7b8153eSMauro Carvalho Chehab for (i = NB_H_FILTER - 1; i > 0; i--)
556*e7b8153eSMauro Carvalho Chehab if ((bdisp_h_filter[i].min < inc) &&
557*e7b8153eSMauro Carvalho Chehab (inc <= bdisp_h_filter[i].max))
558*e7b8153eSMauro Carvalho Chehab break;
559*e7b8153eSMauro Carvalho Chehab
560*e7b8153eSMauro Carvalho Chehab return bdisp_h_filter[i].paddr;
561*e7b8153eSMauro Carvalho Chehab }
562*e7b8153eSMauro Carvalho Chehab
563*e7b8153eSMauro Carvalho Chehab /**
564*e7b8153eSMauro Carvalho Chehab * bdisp_hw_get_vf_addr
565*e7b8153eSMauro Carvalho Chehab * @inc: resize increment
566*e7b8153eSMauro Carvalho Chehab *
567*e7b8153eSMauro Carvalho Chehab * Find the vertical filter table that fits the resize increment
568*e7b8153eSMauro Carvalho Chehab *
569*e7b8153eSMauro Carvalho Chehab * RETURNS:
570*e7b8153eSMauro Carvalho Chehab * table physical address
571*e7b8153eSMauro Carvalho Chehab */
bdisp_hw_get_vf_addr(u16 inc)572*e7b8153eSMauro Carvalho Chehab static dma_addr_t bdisp_hw_get_vf_addr(u16 inc)
573*e7b8153eSMauro Carvalho Chehab {
574*e7b8153eSMauro Carvalho Chehab unsigned int i;
575*e7b8153eSMauro Carvalho Chehab
576*e7b8153eSMauro Carvalho Chehab for (i = NB_V_FILTER - 1; i > 0; i--)
577*e7b8153eSMauro Carvalho Chehab if ((bdisp_v_filter[i].min < inc) &&
578*e7b8153eSMauro Carvalho Chehab (inc <= bdisp_v_filter[i].max))
579*e7b8153eSMauro Carvalho Chehab break;
580*e7b8153eSMauro Carvalho Chehab
581*e7b8153eSMauro Carvalho Chehab return bdisp_v_filter[i].paddr;
582*e7b8153eSMauro Carvalho Chehab }
583*e7b8153eSMauro Carvalho Chehab
584*e7b8153eSMauro Carvalho Chehab /**
585*e7b8153eSMauro Carvalho Chehab * bdisp_hw_get_inc
586*e7b8153eSMauro Carvalho Chehab * @from: input size
587*e7b8153eSMauro Carvalho Chehab * @to: output size
588*e7b8153eSMauro Carvalho Chehab * @inc: resize increment in 6.10 format
589*e7b8153eSMauro Carvalho Chehab *
590*e7b8153eSMauro Carvalho Chehab * Computes the increment (inverse of scale) in 6.10 format
591*e7b8153eSMauro Carvalho Chehab *
592*e7b8153eSMauro Carvalho Chehab * RETURNS:
593*e7b8153eSMauro Carvalho Chehab * 0 on success
594*e7b8153eSMauro Carvalho Chehab */
bdisp_hw_get_inc(u32 from,u32 to,u16 * inc)595*e7b8153eSMauro Carvalho Chehab static int bdisp_hw_get_inc(u32 from, u32 to, u16 *inc)
596*e7b8153eSMauro Carvalho Chehab {
597*e7b8153eSMauro Carvalho Chehab u32 tmp;
598*e7b8153eSMauro Carvalho Chehab
599*e7b8153eSMauro Carvalho Chehab if (!to)
600*e7b8153eSMauro Carvalho Chehab return -EINVAL;
601*e7b8153eSMauro Carvalho Chehab
602*e7b8153eSMauro Carvalho Chehab if (to == from) {
603*e7b8153eSMauro Carvalho Chehab *inc = 1 << 10;
604*e7b8153eSMauro Carvalho Chehab return 0;
605*e7b8153eSMauro Carvalho Chehab }
606*e7b8153eSMauro Carvalho Chehab
607*e7b8153eSMauro Carvalho Chehab tmp = (from << 10) / to;
608*e7b8153eSMauro Carvalho Chehab if ((tmp > 0xFFFF) || (!tmp))
609*e7b8153eSMauro Carvalho Chehab /* overflow (downscale x 63) or too small (upscale x 1024) */
610*e7b8153eSMauro Carvalho Chehab return -EINVAL;
611*e7b8153eSMauro Carvalho Chehab
612*e7b8153eSMauro Carvalho Chehab *inc = (u16)tmp;
613*e7b8153eSMauro Carvalho Chehab
614*e7b8153eSMauro Carvalho Chehab return 0;
615*e7b8153eSMauro Carvalho Chehab }
616*e7b8153eSMauro Carvalho Chehab
617*e7b8153eSMauro Carvalho Chehab /**
618*e7b8153eSMauro Carvalho Chehab * bdisp_hw_get_hv_inc
619*e7b8153eSMauro Carvalho Chehab * @ctx: device context
620*e7b8153eSMauro Carvalho Chehab * @h_inc: horizontal increment
621*e7b8153eSMauro Carvalho Chehab * @v_inc: vertical increment
622*e7b8153eSMauro Carvalho Chehab *
623*e7b8153eSMauro Carvalho Chehab * Computes the horizontal & vertical increments (inverse of scale)
624*e7b8153eSMauro Carvalho Chehab *
625*e7b8153eSMauro Carvalho Chehab * RETURNS:
626*e7b8153eSMauro Carvalho Chehab * 0 on success
627*e7b8153eSMauro Carvalho Chehab */
bdisp_hw_get_hv_inc(struct bdisp_ctx * ctx,u16 * h_inc,u16 * v_inc)628*e7b8153eSMauro Carvalho Chehab static int bdisp_hw_get_hv_inc(struct bdisp_ctx *ctx, u16 *h_inc, u16 *v_inc)
629*e7b8153eSMauro Carvalho Chehab {
630*e7b8153eSMauro Carvalho Chehab u32 src_w, src_h, dst_w, dst_h;
631*e7b8153eSMauro Carvalho Chehab
632*e7b8153eSMauro Carvalho Chehab src_w = ctx->src.crop.width;
633*e7b8153eSMauro Carvalho Chehab src_h = ctx->src.crop.height;
634*e7b8153eSMauro Carvalho Chehab dst_w = ctx->dst.crop.width;
635*e7b8153eSMauro Carvalho Chehab dst_h = ctx->dst.crop.height;
636*e7b8153eSMauro Carvalho Chehab
637*e7b8153eSMauro Carvalho Chehab if (bdisp_hw_get_inc(src_w, dst_w, h_inc) ||
638*e7b8153eSMauro Carvalho Chehab bdisp_hw_get_inc(src_h, dst_h, v_inc)) {
639*e7b8153eSMauro Carvalho Chehab dev_err(ctx->bdisp_dev->dev,
640*e7b8153eSMauro Carvalho Chehab "scale factors failed (%dx%d)->(%dx%d)\n",
641*e7b8153eSMauro Carvalho Chehab src_w, src_h, dst_w, dst_h);
642*e7b8153eSMauro Carvalho Chehab return -EINVAL;
643*e7b8153eSMauro Carvalho Chehab }
644*e7b8153eSMauro Carvalho Chehab
645*e7b8153eSMauro Carvalho Chehab return 0;
646*e7b8153eSMauro Carvalho Chehab }
647*e7b8153eSMauro Carvalho Chehab
648*e7b8153eSMauro Carvalho Chehab /**
649*e7b8153eSMauro Carvalho Chehab * bdisp_hw_get_op_cfg
650*e7b8153eSMauro Carvalho Chehab * @ctx: device context
651*e7b8153eSMauro Carvalho Chehab * @c: operation configuration
652*e7b8153eSMauro Carvalho Chehab *
653*e7b8153eSMauro Carvalho Chehab * Check which blitter operations are expected and sets the scaling increments
654*e7b8153eSMauro Carvalho Chehab *
655*e7b8153eSMauro Carvalho Chehab * RETURNS:
656*e7b8153eSMauro Carvalho Chehab * 0 on success
657*e7b8153eSMauro Carvalho Chehab */
bdisp_hw_get_op_cfg(struct bdisp_ctx * ctx,struct bdisp_op_cfg * c)658*e7b8153eSMauro Carvalho Chehab static int bdisp_hw_get_op_cfg(struct bdisp_ctx *ctx, struct bdisp_op_cfg *c)
659*e7b8153eSMauro Carvalho Chehab {
660*e7b8153eSMauro Carvalho Chehab struct device *dev = ctx->bdisp_dev->dev;
661*e7b8153eSMauro Carvalho Chehab struct bdisp_frame *src = &ctx->src;
662*e7b8153eSMauro Carvalho Chehab struct bdisp_frame *dst = &ctx->dst;
663*e7b8153eSMauro Carvalho Chehab
664*e7b8153eSMauro Carvalho Chehab if (src->width > MAX_SRC_WIDTH * MAX_VERTICAL_STRIDES) {
665*e7b8153eSMauro Carvalho Chehab dev_err(dev, "Image width out of HW caps\n");
666*e7b8153eSMauro Carvalho Chehab return -EINVAL;
667*e7b8153eSMauro Carvalho Chehab }
668*e7b8153eSMauro Carvalho Chehab
669*e7b8153eSMauro Carvalho Chehab c->wide = src->width > MAX_SRC_WIDTH;
670*e7b8153eSMauro Carvalho Chehab
671*e7b8153eSMauro Carvalho Chehab c->hflip = ctx->hflip;
672*e7b8153eSMauro Carvalho Chehab c->vflip = ctx->vflip;
673*e7b8153eSMauro Carvalho Chehab
674*e7b8153eSMauro Carvalho Chehab c->src_interlaced = (src->field == V4L2_FIELD_INTERLACED);
675*e7b8153eSMauro Carvalho Chehab
676*e7b8153eSMauro Carvalho Chehab c->src_nbp = src->fmt->nb_planes;
677*e7b8153eSMauro Carvalho Chehab c->src_yuv = (src->fmt->pixelformat == V4L2_PIX_FMT_NV12) ||
678*e7b8153eSMauro Carvalho Chehab (src->fmt->pixelformat == V4L2_PIX_FMT_YUV420);
679*e7b8153eSMauro Carvalho Chehab c->src_420 = c->src_yuv;
680*e7b8153eSMauro Carvalho Chehab
681*e7b8153eSMauro Carvalho Chehab c->dst_nbp = dst->fmt->nb_planes;
682*e7b8153eSMauro Carvalho Chehab c->dst_yuv = (dst->fmt->pixelformat == V4L2_PIX_FMT_NV12) ||
683*e7b8153eSMauro Carvalho Chehab (dst->fmt->pixelformat == V4L2_PIX_FMT_YUV420);
684*e7b8153eSMauro Carvalho Chehab c->dst_420 = c->dst_yuv;
685*e7b8153eSMauro Carvalho Chehab
686*e7b8153eSMauro Carvalho Chehab c->cconv = (c->src_yuv != c->dst_yuv);
687*e7b8153eSMauro Carvalho Chehab
688*e7b8153eSMauro Carvalho Chehab if (bdisp_hw_get_hv_inc(ctx, &c->h_inc, &c->v_inc)) {
689*e7b8153eSMauro Carvalho Chehab dev_err(dev, "Scale factor out of HW caps\n");
690*e7b8153eSMauro Carvalho Chehab return -EINVAL;
691*e7b8153eSMauro Carvalho Chehab }
692*e7b8153eSMauro Carvalho Chehab
693*e7b8153eSMauro Carvalho Chehab /* Deinterlacing adjustment : stretch a field to a frame */
694*e7b8153eSMauro Carvalho Chehab if (c->src_interlaced)
695*e7b8153eSMauro Carvalho Chehab c->v_inc /= 2;
696*e7b8153eSMauro Carvalho Chehab
697*e7b8153eSMauro Carvalho Chehab if ((c->h_inc != (1 << 10)) || (c->v_inc != (1 << 10)))
698*e7b8153eSMauro Carvalho Chehab c->scale = true;
699*e7b8153eSMauro Carvalho Chehab else
700*e7b8153eSMauro Carvalho Chehab c->scale = false;
701*e7b8153eSMauro Carvalho Chehab
702*e7b8153eSMauro Carvalho Chehab return 0;
703*e7b8153eSMauro Carvalho Chehab }
704*e7b8153eSMauro Carvalho Chehab
705*e7b8153eSMauro Carvalho Chehab /**
706*e7b8153eSMauro Carvalho Chehab * bdisp_hw_color_format
707*e7b8153eSMauro Carvalho Chehab * @pixelformat: v4l2 pixel format
708*e7b8153eSMauro Carvalho Chehab *
709*e7b8153eSMauro Carvalho Chehab * v4l2 to bdisp pixel format convert
710*e7b8153eSMauro Carvalho Chehab *
711*e7b8153eSMauro Carvalho Chehab * RETURNS:
712*e7b8153eSMauro Carvalho Chehab * bdisp pixel format
713*e7b8153eSMauro Carvalho Chehab */
bdisp_hw_color_format(u32 pixelformat)714*e7b8153eSMauro Carvalho Chehab static u32 bdisp_hw_color_format(u32 pixelformat)
715*e7b8153eSMauro Carvalho Chehab {
716*e7b8153eSMauro Carvalho Chehab u32 ret;
717*e7b8153eSMauro Carvalho Chehab
718*e7b8153eSMauro Carvalho Chehab switch (pixelformat) {
719*e7b8153eSMauro Carvalho Chehab case V4L2_PIX_FMT_YUV420:
720*e7b8153eSMauro Carvalho Chehab ret = (BDISP_YUV_3B << BLT_TTY_COL_SHIFT);
721*e7b8153eSMauro Carvalho Chehab break;
722*e7b8153eSMauro Carvalho Chehab case V4L2_PIX_FMT_NV12:
723*e7b8153eSMauro Carvalho Chehab ret = (BDISP_NV12 << BLT_TTY_COL_SHIFT) | BLT_TTY_BIG_END;
724*e7b8153eSMauro Carvalho Chehab break;
725*e7b8153eSMauro Carvalho Chehab case V4L2_PIX_FMT_RGB565:
726*e7b8153eSMauro Carvalho Chehab ret = (BDISP_RGB565 << BLT_TTY_COL_SHIFT);
727*e7b8153eSMauro Carvalho Chehab break;
728*e7b8153eSMauro Carvalho Chehab case V4L2_PIX_FMT_XBGR32: /* This V4L format actually refers to xRGB */
729*e7b8153eSMauro Carvalho Chehab ret = (BDISP_XRGB8888 << BLT_TTY_COL_SHIFT);
730*e7b8153eSMauro Carvalho Chehab break;
731*e7b8153eSMauro Carvalho Chehab case V4L2_PIX_FMT_RGB24: /* RGB888 format */
732*e7b8153eSMauro Carvalho Chehab ret = (BDISP_RGB888 << BLT_TTY_COL_SHIFT) | BLT_TTY_BIG_END;
733*e7b8153eSMauro Carvalho Chehab break;
734*e7b8153eSMauro Carvalho Chehab case V4L2_PIX_FMT_ABGR32: /* This V4L format actually refers to ARGB */
735*e7b8153eSMauro Carvalho Chehab
736*e7b8153eSMauro Carvalho Chehab default:
737*e7b8153eSMauro Carvalho Chehab ret = (BDISP_ARGB8888 << BLT_TTY_COL_SHIFT) | BLT_TTY_ALPHA_R;
738*e7b8153eSMauro Carvalho Chehab break;
739*e7b8153eSMauro Carvalho Chehab }
740*e7b8153eSMauro Carvalho Chehab
741*e7b8153eSMauro Carvalho Chehab return ret;
742*e7b8153eSMauro Carvalho Chehab }
743*e7b8153eSMauro Carvalho Chehab
744*e7b8153eSMauro Carvalho Chehab /**
745*e7b8153eSMauro Carvalho Chehab * bdisp_hw_build_node
746*e7b8153eSMauro Carvalho Chehab * @ctx: device context
747*e7b8153eSMauro Carvalho Chehab * @cfg: operation configuration
748*e7b8153eSMauro Carvalho Chehab * @node: node to be set
749*e7b8153eSMauro Carvalho Chehab * @t_plan: whether the node refers to a RGB/Y or a CbCr plane
750*e7b8153eSMauro Carvalho Chehab * @src_x_offset: x offset in the source image
751*e7b8153eSMauro Carvalho Chehab *
752*e7b8153eSMauro Carvalho Chehab * Build a node
753*e7b8153eSMauro Carvalho Chehab *
754*e7b8153eSMauro Carvalho Chehab * RETURNS:
755*e7b8153eSMauro Carvalho Chehab * None
756*e7b8153eSMauro Carvalho Chehab */
bdisp_hw_build_node(struct bdisp_ctx * ctx,struct bdisp_op_cfg * cfg,struct bdisp_node * node,enum bdisp_target_plan t_plan,int src_x_offset)757*e7b8153eSMauro Carvalho Chehab static void bdisp_hw_build_node(struct bdisp_ctx *ctx,
758*e7b8153eSMauro Carvalho Chehab struct bdisp_op_cfg *cfg,
759*e7b8153eSMauro Carvalho Chehab struct bdisp_node *node,
760*e7b8153eSMauro Carvalho Chehab enum bdisp_target_plan t_plan, int src_x_offset)
761*e7b8153eSMauro Carvalho Chehab {
762*e7b8153eSMauro Carvalho Chehab struct bdisp_frame *src = &ctx->src;
763*e7b8153eSMauro Carvalho Chehab struct bdisp_frame *dst = &ctx->dst;
764*e7b8153eSMauro Carvalho Chehab u16 h_inc, v_inc, yh_inc, yv_inc;
765*e7b8153eSMauro Carvalho Chehab struct v4l2_rect src_rect = src->crop;
766*e7b8153eSMauro Carvalho Chehab struct v4l2_rect dst_rect = dst->crop;
767*e7b8153eSMauro Carvalho Chehab int dst_x_offset;
768*e7b8153eSMauro Carvalho Chehab s32 dst_width = dst->crop.width;
769*e7b8153eSMauro Carvalho Chehab u32 src_fmt, dst_fmt;
770*e7b8153eSMauro Carvalho Chehab const u32 *ivmx;
771*e7b8153eSMauro Carvalho Chehab
772*e7b8153eSMauro Carvalho Chehab dev_dbg(ctx->bdisp_dev->dev, "%s\n", __func__);
773*e7b8153eSMauro Carvalho Chehab
774*e7b8153eSMauro Carvalho Chehab memset(node, 0, sizeof(*node));
775*e7b8153eSMauro Carvalho Chehab
776*e7b8153eSMauro Carvalho Chehab /* Adjust src and dst areas wrt src_x_offset */
777*e7b8153eSMauro Carvalho Chehab src_rect.left += src_x_offset;
778*e7b8153eSMauro Carvalho Chehab src_rect.width -= src_x_offset;
779*e7b8153eSMauro Carvalho Chehab src_rect.width = min_t(__s32, MAX_SRC_WIDTH, src_rect.width);
780*e7b8153eSMauro Carvalho Chehab
781*e7b8153eSMauro Carvalho Chehab dst_x_offset = (src_x_offset * dst_width) / ctx->src.crop.width;
782*e7b8153eSMauro Carvalho Chehab dst_rect.left += dst_x_offset;
783*e7b8153eSMauro Carvalho Chehab dst_rect.width = (src_rect.width * dst_width) / ctx->src.crop.width;
784*e7b8153eSMauro Carvalho Chehab
785*e7b8153eSMauro Carvalho Chehab /* General */
786*e7b8153eSMauro Carvalho Chehab src_fmt = src->fmt->pixelformat;
787*e7b8153eSMauro Carvalho Chehab dst_fmt = dst->fmt->pixelformat;
788*e7b8153eSMauro Carvalho Chehab
789*e7b8153eSMauro Carvalho Chehab node->nip = 0;
790*e7b8153eSMauro Carvalho Chehab node->cic = BLT_CIC_ALL_GRP;
791*e7b8153eSMauro Carvalho Chehab node->ack = BLT_ACK_BYPASS_S2S3;
792*e7b8153eSMauro Carvalho Chehab
793*e7b8153eSMauro Carvalho Chehab switch (cfg->src_nbp) {
794*e7b8153eSMauro Carvalho Chehab case 1:
795*e7b8153eSMauro Carvalho Chehab /* Src2 = RGB / Src1 = Src3 = off */
796*e7b8153eSMauro Carvalho Chehab node->ins = BLT_INS_S1_OFF | BLT_INS_S2_MEM | BLT_INS_S3_OFF;
797*e7b8153eSMauro Carvalho Chehab break;
798*e7b8153eSMauro Carvalho Chehab case 2:
799*e7b8153eSMauro Carvalho Chehab /* Src3 = Y
800*e7b8153eSMauro Carvalho Chehab * Src2 = CbCr or ColorFill if writing the Y plane
801*e7b8153eSMauro Carvalho Chehab * Src1 = off */
802*e7b8153eSMauro Carvalho Chehab node->ins = BLT_INS_S1_OFF | BLT_INS_S3_MEM;
803*e7b8153eSMauro Carvalho Chehab if (t_plan == BDISP_Y)
804*e7b8153eSMauro Carvalho Chehab node->ins |= BLT_INS_S2_CF;
805*e7b8153eSMauro Carvalho Chehab else
806*e7b8153eSMauro Carvalho Chehab node->ins |= BLT_INS_S2_MEM;
807*e7b8153eSMauro Carvalho Chehab break;
808*e7b8153eSMauro Carvalho Chehab case 3:
809*e7b8153eSMauro Carvalho Chehab default:
810*e7b8153eSMauro Carvalho Chehab /* Src3 = Y
811*e7b8153eSMauro Carvalho Chehab * Src2 = Cb or ColorFill if writing the Y plane
812*e7b8153eSMauro Carvalho Chehab * Src1 = Cr or ColorFill if writing the Y plane */
813*e7b8153eSMauro Carvalho Chehab node->ins = BLT_INS_S3_MEM;
814*e7b8153eSMauro Carvalho Chehab if (t_plan == BDISP_Y)
815*e7b8153eSMauro Carvalho Chehab node->ins |= BLT_INS_S2_CF | BLT_INS_S1_CF;
816*e7b8153eSMauro Carvalho Chehab else
817*e7b8153eSMauro Carvalho Chehab node->ins |= BLT_INS_S2_MEM | BLT_INS_S1_MEM;
818*e7b8153eSMauro Carvalho Chehab break;
819*e7b8153eSMauro Carvalho Chehab }
820*e7b8153eSMauro Carvalho Chehab
821*e7b8153eSMauro Carvalho Chehab /* Color convert */
822*e7b8153eSMauro Carvalho Chehab node->ins |= cfg->cconv ? BLT_INS_IVMX : 0;
823*e7b8153eSMauro Carvalho Chehab /* Scale needed if scaling OR 4:2:0 up/downsampling */
824*e7b8153eSMauro Carvalho Chehab node->ins |= (cfg->scale || cfg->src_420 || cfg->dst_420) ?
825*e7b8153eSMauro Carvalho Chehab BLT_INS_SCALE : 0;
826*e7b8153eSMauro Carvalho Chehab
827*e7b8153eSMauro Carvalho Chehab /* Target */
828*e7b8153eSMauro Carvalho Chehab node->tba = (t_plan == BDISP_CBCR) ? dst->paddr[1] : dst->paddr[0];
829*e7b8153eSMauro Carvalho Chehab
830*e7b8153eSMauro Carvalho Chehab node->tty = dst->bytesperline;
831*e7b8153eSMauro Carvalho Chehab node->tty |= bdisp_hw_color_format(dst_fmt);
832*e7b8153eSMauro Carvalho Chehab node->tty |= BLT_TTY_DITHER;
833*e7b8153eSMauro Carvalho Chehab node->tty |= (t_plan == BDISP_CBCR) ? BLT_TTY_CHROMA : 0;
834*e7b8153eSMauro Carvalho Chehab node->tty |= cfg->hflip ? BLT_TTY_HSO : 0;
835*e7b8153eSMauro Carvalho Chehab node->tty |= cfg->vflip ? BLT_TTY_VSO : 0;
836*e7b8153eSMauro Carvalho Chehab
837*e7b8153eSMauro Carvalho Chehab if (cfg->dst_420 && (t_plan == BDISP_CBCR)) {
838*e7b8153eSMauro Carvalho Chehab /* 420 chroma downsampling */
839*e7b8153eSMauro Carvalho Chehab dst_rect.height /= 2;
840*e7b8153eSMauro Carvalho Chehab dst_rect.width /= 2;
841*e7b8153eSMauro Carvalho Chehab dst_rect.left /= 2;
842*e7b8153eSMauro Carvalho Chehab dst_rect.top /= 2;
843*e7b8153eSMauro Carvalho Chehab dst_x_offset /= 2;
844*e7b8153eSMauro Carvalho Chehab dst_width /= 2;
845*e7b8153eSMauro Carvalho Chehab }
846*e7b8153eSMauro Carvalho Chehab
847*e7b8153eSMauro Carvalho Chehab node->txy = cfg->vflip ? (dst_rect.height - 1) : dst_rect.top;
848*e7b8153eSMauro Carvalho Chehab node->txy <<= 16;
849*e7b8153eSMauro Carvalho Chehab node->txy |= cfg->hflip ? (dst_width - dst_x_offset - 1) :
850*e7b8153eSMauro Carvalho Chehab dst_rect.left;
851*e7b8153eSMauro Carvalho Chehab
852*e7b8153eSMauro Carvalho Chehab node->tsz = dst_rect.height << 16 | dst_rect.width;
853*e7b8153eSMauro Carvalho Chehab
854*e7b8153eSMauro Carvalho Chehab if (cfg->src_interlaced) {
855*e7b8153eSMauro Carvalho Chehab /* handle only the top field which is half height of a frame */
856*e7b8153eSMauro Carvalho Chehab src_rect.top /= 2;
857*e7b8153eSMauro Carvalho Chehab src_rect.height /= 2;
858*e7b8153eSMauro Carvalho Chehab }
859*e7b8153eSMauro Carvalho Chehab
860*e7b8153eSMauro Carvalho Chehab if (cfg->src_nbp == 1) {
861*e7b8153eSMauro Carvalho Chehab /* Src 2 : RGB */
862*e7b8153eSMauro Carvalho Chehab node->s2ba = src->paddr[0];
863*e7b8153eSMauro Carvalho Chehab
864*e7b8153eSMauro Carvalho Chehab node->s2ty = src->bytesperline;
865*e7b8153eSMauro Carvalho Chehab if (cfg->src_interlaced)
866*e7b8153eSMauro Carvalho Chehab node->s2ty *= 2;
867*e7b8153eSMauro Carvalho Chehab
868*e7b8153eSMauro Carvalho Chehab node->s2ty |= bdisp_hw_color_format(src_fmt);
869*e7b8153eSMauro Carvalho Chehab
870*e7b8153eSMauro Carvalho Chehab node->s2xy = src_rect.top << 16 | src_rect.left;
871*e7b8153eSMauro Carvalho Chehab node->s2sz = src_rect.height << 16 | src_rect.width;
872*e7b8153eSMauro Carvalho Chehab } else {
873*e7b8153eSMauro Carvalho Chehab /* Src 2 : Cb or CbCr */
874*e7b8153eSMauro Carvalho Chehab if (cfg->src_420) {
875*e7b8153eSMauro Carvalho Chehab /* 420 chroma upsampling */
876*e7b8153eSMauro Carvalho Chehab src_rect.top /= 2;
877*e7b8153eSMauro Carvalho Chehab src_rect.left /= 2;
878*e7b8153eSMauro Carvalho Chehab src_rect.width /= 2;
879*e7b8153eSMauro Carvalho Chehab src_rect.height /= 2;
880*e7b8153eSMauro Carvalho Chehab }
881*e7b8153eSMauro Carvalho Chehab
882*e7b8153eSMauro Carvalho Chehab node->s2ba = src->paddr[1];
883*e7b8153eSMauro Carvalho Chehab
884*e7b8153eSMauro Carvalho Chehab node->s2ty = src->bytesperline;
885*e7b8153eSMauro Carvalho Chehab if (cfg->src_nbp == 3)
886*e7b8153eSMauro Carvalho Chehab node->s2ty /= 2;
887*e7b8153eSMauro Carvalho Chehab if (cfg->src_interlaced)
888*e7b8153eSMauro Carvalho Chehab node->s2ty *= 2;
889*e7b8153eSMauro Carvalho Chehab
890*e7b8153eSMauro Carvalho Chehab node->s2ty |= bdisp_hw_color_format(src_fmt);
891*e7b8153eSMauro Carvalho Chehab
892*e7b8153eSMauro Carvalho Chehab node->s2xy = src_rect.top << 16 | src_rect.left;
893*e7b8153eSMauro Carvalho Chehab node->s2sz = src_rect.height << 16 | src_rect.width;
894*e7b8153eSMauro Carvalho Chehab
895*e7b8153eSMauro Carvalho Chehab if (cfg->src_nbp == 3) {
896*e7b8153eSMauro Carvalho Chehab /* Src 1 : Cr */
897*e7b8153eSMauro Carvalho Chehab node->s1ba = src->paddr[2];
898*e7b8153eSMauro Carvalho Chehab
899*e7b8153eSMauro Carvalho Chehab node->s1ty = node->s2ty;
900*e7b8153eSMauro Carvalho Chehab node->s1xy = node->s2xy;
901*e7b8153eSMauro Carvalho Chehab }
902*e7b8153eSMauro Carvalho Chehab
903*e7b8153eSMauro Carvalho Chehab /* Src 3 : Y */
904*e7b8153eSMauro Carvalho Chehab node->s3ba = src->paddr[0];
905*e7b8153eSMauro Carvalho Chehab
906*e7b8153eSMauro Carvalho Chehab node->s3ty = src->bytesperline;
907*e7b8153eSMauro Carvalho Chehab if (cfg->src_interlaced)
908*e7b8153eSMauro Carvalho Chehab node->s3ty *= 2;
909*e7b8153eSMauro Carvalho Chehab node->s3ty |= bdisp_hw_color_format(src_fmt);
910*e7b8153eSMauro Carvalho Chehab
911*e7b8153eSMauro Carvalho Chehab if ((t_plan != BDISP_CBCR) && cfg->src_420) {
912*e7b8153eSMauro Carvalho Chehab /* No chroma upsampling for output RGB / Y plane */
913*e7b8153eSMauro Carvalho Chehab node->s3xy = node->s2xy * 2;
914*e7b8153eSMauro Carvalho Chehab node->s3sz = node->s2sz * 2;
915*e7b8153eSMauro Carvalho Chehab } else {
916*e7b8153eSMauro Carvalho Chehab /* No need to read Y (Src3) when writing Chroma */
917*e7b8153eSMauro Carvalho Chehab node->s3ty |= BLT_S3TY_BLANK_ACC;
918*e7b8153eSMauro Carvalho Chehab node->s3xy = node->s2xy;
919*e7b8153eSMauro Carvalho Chehab node->s3sz = node->s2sz;
920*e7b8153eSMauro Carvalho Chehab }
921*e7b8153eSMauro Carvalho Chehab }
922*e7b8153eSMauro Carvalho Chehab
923*e7b8153eSMauro Carvalho Chehab /* Resize (scale OR 4:2:0: chroma up/downsampling) */
924*e7b8153eSMauro Carvalho Chehab if (node->ins & BLT_INS_SCALE) {
925*e7b8153eSMauro Carvalho Chehab /* no need to compute Y when writing CbCr from RGB input */
926*e7b8153eSMauro Carvalho Chehab bool skip_y = (t_plan == BDISP_CBCR) && !cfg->src_yuv;
927*e7b8153eSMauro Carvalho Chehab
928*e7b8153eSMauro Carvalho Chehab /* FCTL */
929*e7b8153eSMauro Carvalho Chehab if (cfg->scale) {
930*e7b8153eSMauro Carvalho Chehab node->fctl = BLT_FCTL_HV_SCALE;
931*e7b8153eSMauro Carvalho Chehab if (!skip_y)
932*e7b8153eSMauro Carvalho Chehab node->fctl |= BLT_FCTL_Y_HV_SCALE;
933*e7b8153eSMauro Carvalho Chehab } else {
934*e7b8153eSMauro Carvalho Chehab node->fctl = BLT_FCTL_HV_SAMPLE;
935*e7b8153eSMauro Carvalho Chehab if (!skip_y)
936*e7b8153eSMauro Carvalho Chehab node->fctl |= BLT_FCTL_Y_HV_SAMPLE;
937*e7b8153eSMauro Carvalho Chehab }
938*e7b8153eSMauro Carvalho Chehab
939*e7b8153eSMauro Carvalho Chehab /* RSF - Chroma may need to be up/downsampled */
940*e7b8153eSMauro Carvalho Chehab h_inc = cfg->h_inc;
941*e7b8153eSMauro Carvalho Chehab v_inc = cfg->v_inc;
942*e7b8153eSMauro Carvalho Chehab if (!cfg->src_420 && cfg->dst_420 && (t_plan == BDISP_CBCR)) {
943*e7b8153eSMauro Carvalho Chehab /* RGB to 4:2:0 for Chroma: downsample */
944*e7b8153eSMauro Carvalho Chehab h_inc *= 2;
945*e7b8153eSMauro Carvalho Chehab v_inc *= 2;
946*e7b8153eSMauro Carvalho Chehab } else if (cfg->src_420 && !cfg->dst_420) {
947*e7b8153eSMauro Carvalho Chehab /* 4:2:0: to RGB: upsample*/
948*e7b8153eSMauro Carvalho Chehab h_inc /= 2;
949*e7b8153eSMauro Carvalho Chehab v_inc /= 2;
950*e7b8153eSMauro Carvalho Chehab }
951*e7b8153eSMauro Carvalho Chehab node->rsf = v_inc << 16 | h_inc;
952*e7b8153eSMauro Carvalho Chehab
953*e7b8153eSMauro Carvalho Chehab /* RZI */
954*e7b8153eSMauro Carvalho Chehab node->rzi = BLT_RZI_DEFAULT;
955*e7b8153eSMauro Carvalho Chehab
956*e7b8153eSMauro Carvalho Chehab /* Filter table physical addr */
957*e7b8153eSMauro Carvalho Chehab node->hfp = bdisp_hw_get_hf_addr(h_inc);
958*e7b8153eSMauro Carvalho Chehab node->vfp = bdisp_hw_get_vf_addr(v_inc);
959*e7b8153eSMauro Carvalho Chehab
960*e7b8153eSMauro Carvalho Chehab /* Y version */
961*e7b8153eSMauro Carvalho Chehab if (!skip_y) {
962*e7b8153eSMauro Carvalho Chehab yh_inc = cfg->h_inc;
963*e7b8153eSMauro Carvalho Chehab yv_inc = cfg->v_inc;
964*e7b8153eSMauro Carvalho Chehab
965*e7b8153eSMauro Carvalho Chehab node->y_rsf = yv_inc << 16 | yh_inc;
966*e7b8153eSMauro Carvalho Chehab node->y_rzi = BLT_RZI_DEFAULT;
967*e7b8153eSMauro Carvalho Chehab node->y_hfp = bdisp_hw_get_hf_addr(yh_inc);
968*e7b8153eSMauro Carvalho Chehab node->y_vfp = bdisp_hw_get_vf_addr(yv_inc);
969*e7b8153eSMauro Carvalho Chehab }
970*e7b8153eSMauro Carvalho Chehab }
971*e7b8153eSMauro Carvalho Chehab
972*e7b8153eSMauro Carvalho Chehab /* Versatile matrix for RGB / YUV conversion */
973*e7b8153eSMauro Carvalho Chehab if (cfg->cconv) {
974*e7b8153eSMauro Carvalho Chehab ivmx = cfg->src_yuv ? bdisp_yuv_to_rgb : bdisp_rgb_to_yuv;
975*e7b8153eSMauro Carvalho Chehab
976*e7b8153eSMauro Carvalho Chehab node->ivmx0 = ivmx[0];
977*e7b8153eSMauro Carvalho Chehab node->ivmx1 = ivmx[1];
978*e7b8153eSMauro Carvalho Chehab node->ivmx2 = ivmx[2];
979*e7b8153eSMauro Carvalho Chehab node->ivmx3 = ivmx[3];
980*e7b8153eSMauro Carvalho Chehab }
981*e7b8153eSMauro Carvalho Chehab }
982*e7b8153eSMauro Carvalho Chehab
983*e7b8153eSMauro Carvalho Chehab /**
984*e7b8153eSMauro Carvalho Chehab * bdisp_hw_build_all_nodes
985*e7b8153eSMauro Carvalho Chehab * @ctx: device context
986*e7b8153eSMauro Carvalho Chehab *
987*e7b8153eSMauro Carvalho Chehab * Build all the nodes for the blitter operation
988*e7b8153eSMauro Carvalho Chehab *
989*e7b8153eSMauro Carvalho Chehab * RETURNS:
990*e7b8153eSMauro Carvalho Chehab * 0 on success
991*e7b8153eSMauro Carvalho Chehab */
bdisp_hw_build_all_nodes(struct bdisp_ctx * ctx)992*e7b8153eSMauro Carvalho Chehab static int bdisp_hw_build_all_nodes(struct bdisp_ctx *ctx)
993*e7b8153eSMauro Carvalho Chehab {
994*e7b8153eSMauro Carvalho Chehab struct bdisp_op_cfg cfg;
995*e7b8153eSMauro Carvalho Chehab unsigned int i, nid = 0;
996*e7b8153eSMauro Carvalho Chehab int src_x_offset = 0;
997*e7b8153eSMauro Carvalho Chehab
998*e7b8153eSMauro Carvalho Chehab for (i = 0; i < MAX_NB_NODE; i++)
999*e7b8153eSMauro Carvalho Chehab if (!ctx->node[i]) {
1000*e7b8153eSMauro Carvalho Chehab dev_err(ctx->bdisp_dev->dev, "node %d is null\n", i);
1001*e7b8153eSMauro Carvalho Chehab return -EINVAL;
1002*e7b8153eSMauro Carvalho Chehab }
1003*e7b8153eSMauro Carvalho Chehab
1004*e7b8153eSMauro Carvalho Chehab /* Get configuration (scale, flip, ...) */
1005*e7b8153eSMauro Carvalho Chehab if (bdisp_hw_get_op_cfg(ctx, &cfg))
1006*e7b8153eSMauro Carvalho Chehab return -EINVAL;
1007*e7b8153eSMauro Carvalho Chehab
1008*e7b8153eSMauro Carvalho Chehab /* Split source in vertical strides (HW constraint) */
1009*e7b8153eSMauro Carvalho Chehab for (i = 0; i < MAX_VERTICAL_STRIDES; i++) {
1010*e7b8153eSMauro Carvalho Chehab /* Build RGB/Y node and link it to the previous node */
1011*e7b8153eSMauro Carvalho Chehab bdisp_hw_build_node(ctx, &cfg, ctx->node[nid],
1012*e7b8153eSMauro Carvalho Chehab cfg.dst_nbp == 1 ? BDISP_RGB : BDISP_Y,
1013*e7b8153eSMauro Carvalho Chehab src_x_offset);
1014*e7b8153eSMauro Carvalho Chehab if (nid)
1015*e7b8153eSMauro Carvalho Chehab ctx->node[nid - 1]->nip = ctx->node_paddr[nid];
1016*e7b8153eSMauro Carvalho Chehab nid++;
1017*e7b8153eSMauro Carvalho Chehab
1018*e7b8153eSMauro Carvalho Chehab /* Build additional Cb(Cr) node, link it to the previous one */
1019*e7b8153eSMauro Carvalho Chehab if (cfg.dst_nbp > 1) {
1020*e7b8153eSMauro Carvalho Chehab bdisp_hw_build_node(ctx, &cfg, ctx->node[nid],
1021*e7b8153eSMauro Carvalho Chehab BDISP_CBCR, src_x_offset);
1022*e7b8153eSMauro Carvalho Chehab ctx->node[nid - 1]->nip = ctx->node_paddr[nid];
1023*e7b8153eSMauro Carvalho Chehab nid++;
1024*e7b8153eSMauro Carvalho Chehab }
1025*e7b8153eSMauro Carvalho Chehab
1026*e7b8153eSMauro Carvalho Chehab /* Next stride until full width covered */
1027*e7b8153eSMauro Carvalho Chehab src_x_offset += MAX_SRC_WIDTH;
1028*e7b8153eSMauro Carvalho Chehab if (src_x_offset >= ctx->src.crop.width)
1029*e7b8153eSMauro Carvalho Chehab break;
1030*e7b8153eSMauro Carvalho Chehab }
1031*e7b8153eSMauro Carvalho Chehab
1032*e7b8153eSMauro Carvalho Chehab /* Mark last node as the last */
1033*e7b8153eSMauro Carvalho Chehab ctx->node[nid - 1]->nip = 0;
1034*e7b8153eSMauro Carvalho Chehab
1035*e7b8153eSMauro Carvalho Chehab return 0;
1036*e7b8153eSMauro Carvalho Chehab }
1037*e7b8153eSMauro Carvalho Chehab
1038*e7b8153eSMauro Carvalho Chehab /**
1039*e7b8153eSMauro Carvalho Chehab * bdisp_hw_save_request
1040*e7b8153eSMauro Carvalho Chehab * @ctx: device context
1041*e7b8153eSMauro Carvalho Chehab *
1042*e7b8153eSMauro Carvalho Chehab * Save a copy of the request and of the built nodes
1043*e7b8153eSMauro Carvalho Chehab *
1044*e7b8153eSMauro Carvalho Chehab * RETURNS:
1045*e7b8153eSMauro Carvalho Chehab * None
1046*e7b8153eSMauro Carvalho Chehab */
bdisp_hw_save_request(struct bdisp_ctx * ctx)1047*e7b8153eSMauro Carvalho Chehab static void bdisp_hw_save_request(struct bdisp_ctx *ctx)
1048*e7b8153eSMauro Carvalho Chehab {
1049*e7b8153eSMauro Carvalho Chehab struct bdisp_node **copy_node = ctx->bdisp_dev->dbg.copy_node;
1050*e7b8153eSMauro Carvalho Chehab struct bdisp_request *request = &ctx->bdisp_dev->dbg.copy_request;
1051*e7b8153eSMauro Carvalho Chehab struct bdisp_node **node = ctx->node;
1052*e7b8153eSMauro Carvalho Chehab int i;
1053*e7b8153eSMauro Carvalho Chehab
1054*e7b8153eSMauro Carvalho Chehab /* Request copy */
1055*e7b8153eSMauro Carvalho Chehab request->src = ctx->src;
1056*e7b8153eSMauro Carvalho Chehab request->dst = ctx->dst;
1057*e7b8153eSMauro Carvalho Chehab request->hflip = ctx->hflip;
1058*e7b8153eSMauro Carvalho Chehab request->vflip = ctx->vflip;
1059*e7b8153eSMauro Carvalho Chehab request->nb_req++;
1060*e7b8153eSMauro Carvalho Chehab
1061*e7b8153eSMauro Carvalho Chehab /* Nodes copy */
1062*e7b8153eSMauro Carvalho Chehab for (i = 0; i < MAX_NB_NODE; i++) {
1063*e7b8153eSMauro Carvalho Chehab /* Allocate memory if not done yet */
1064*e7b8153eSMauro Carvalho Chehab if (!copy_node[i]) {
1065*e7b8153eSMauro Carvalho Chehab copy_node[i] = devm_kzalloc(ctx->bdisp_dev->dev,
1066*e7b8153eSMauro Carvalho Chehab sizeof(*copy_node[i]),
1067*e7b8153eSMauro Carvalho Chehab GFP_ATOMIC);
1068*e7b8153eSMauro Carvalho Chehab if (!copy_node[i])
1069*e7b8153eSMauro Carvalho Chehab return;
1070*e7b8153eSMauro Carvalho Chehab }
1071*e7b8153eSMauro Carvalho Chehab *copy_node[i] = *node[i];
1072*e7b8153eSMauro Carvalho Chehab }
1073*e7b8153eSMauro Carvalho Chehab }
1074*e7b8153eSMauro Carvalho Chehab
1075*e7b8153eSMauro Carvalho Chehab /**
1076*e7b8153eSMauro Carvalho Chehab * bdisp_hw_update
1077*e7b8153eSMauro Carvalho Chehab * @ctx: device context
1078*e7b8153eSMauro Carvalho Chehab *
1079*e7b8153eSMauro Carvalho Chehab * Send the request to the HW
1080*e7b8153eSMauro Carvalho Chehab *
1081*e7b8153eSMauro Carvalho Chehab * RETURNS:
1082*e7b8153eSMauro Carvalho Chehab * 0 on success
1083*e7b8153eSMauro Carvalho Chehab */
bdisp_hw_update(struct bdisp_ctx * ctx)1084*e7b8153eSMauro Carvalho Chehab int bdisp_hw_update(struct bdisp_ctx *ctx)
1085*e7b8153eSMauro Carvalho Chehab {
1086*e7b8153eSMauro Carvalho Chehab int ret;
1087*e7b8153eSMauro Carvalho Chehab struct bdisp_dev *bdisp = ctx->bdisp_dev;
1088*e7b8153eSMauro Carvalho Chehab struct device *dev = bdisp->dev;
1089*e7b8153eSMauro Carvalho Chehab unsigned int node_id;
1090*e7b8153eSMauro Carvalho Chehab
1091*e7b8153eSMauro Carvalho Chehab dev_dbg(dev, "%s\n", __func__);
1092*e7b8153eSMauro Carvalho Chehab
1093*e7b8153eSMauro Carvalho Chehab /* build nodes */
1094*e7b8153eSMauro Carvalho Chehab ret = bdisp_hw_build_all_nodes(ctx);
1095*e7b8153eSMauro Carvalho Chehab if (ret) {
1096*e7b8153eSMauro Carvalho Chehab dev_err(dev, "cannot build nodes (%d)\n", ret);
1097*e7b8153eSMauro Carvalho Chehab return ret;
1098*e7b8153eSMauro Carvalho Chehab }
1099*e7b8153eSMauro Carvalho Chehab
1100*e7b8153eSMauro Carvalho Chehab /* Save a copy of the request */
1101*e7b8153eSMauro Carvalho Chehab bdisp_hw_save_request(ctx);
1102*e7b8153eSMauro Carvalho Chehab
1103*e7b8153eSMauro Carvalho Chehab /* Configure interrupt to 'Last Node Reached for AQ1' */
1104*e7b8153eSMauro Carvalho Chehab writel(BLT_AQ1_CTL_CFG, bdisp->regs + BLT_AQ1_CTL);
1105*e7b8153eSMauro Carvalho Chehab writel(BLT_ITS_AQ1_LNA, bdisp->regs + BLT_ITM0);
1106*e7b8153eSMauro Carvalho Chehab
1107*e7b8153eSMauro Carvalho Chehab /* Write first node addr */
1108*e7b8153eSMauro Carvalho Chehab writel(ctx->node_paddr[0], bdisp->regs + BLT_AQ1_IP);
1109*e7b8153eSMauro Carvalho Chehab
1110*e7b8153eSMauro Carvalho Chehab /* Find and write last node addr : this starts the HW processing */
1111*e7b8153eSMauro Carvalho Chehab for (node_id = 0; node_id < MAX_NB_NODE - 1; node_id++) {
1112*e7b8153eSMauro Carvalho Chehab if (!ctx->node[node_id]->nip)
1113*e7b8153eSMauro Carvalho Chehab break;
1114*e7b8153eSMauro Carvalho Chehab }
1115*e7b8153eSMauro Carvalho Chehab writel(ctx->node_paddr[node_id], bdisp->regs + BLT_AQ1_LNA);
1116*e7b8153eSMauro Carvalho Chehab
1117*e7b8153eSMauro Carvalho Chehab return 0;
1118*e7b8153eSMauro Carvalho Chehab }
1119