1b873663bSTodor Tomov // SPDX-License-Identifier: GPL-2.0
2ec6859b2STodor Tomov /*
3ec6859b2STodor Tomov * camss-csiphy.c
4ec6859b2STodor Tomov *
5ec6859b2STodor Tomov * Qualcomm MSM Camera Subsystem - CSIPHY Module
6ec6859b2STodor Tomov *
7ec6859b2STodor Tomov * Copyright (c) 2011-2015, The Linux Foundation. All rights reserved.
8ec6859b2STodor Tomov * Copyright (C) 2016-2018 Linaro Ltd.
9ec6859b2STodor Tomov */
10ec6859b2STodor Tomov #include <linux/clk.h>
11ec6859b2STodor Tomov #include <linux/delay.h>
12ec6859b2STodor Tomov #include <linux/interrupt.h>
133799eca5SArnd Bergmann #include <linux/io.h>
14ec6859b2STodor Tomov #include <linux/kernel.h>
15ec6859b2STodor Tomov #include <linux/of.h>
16ec6859b2STodor Tomov #include <linux/platform_device.h>
1702afa816STodor Tomov #include <linux/pm_runtime.h>
18ec6859b2STodor Tomov #include <media/media-entity.h>
19ec6859b2STodor Tomov #include <media/v4l2-device.h>
20ec6859b2STodor Tomov #include <media/v4l2-subdev.h>
21ec6859b2STodor Tomov
22ec6859b2STodor Tomov #include "camss-csiphy.h"
23ec6859b2STodor Tomov #include "camss.h"
24ec6859b2STodor Tomov
25ec6859b2STodor Tomov #define MSM_CSIPHY_NAME "msm_csiphy"
26ec6859b2STodor Tomov
27*e05d1be9SRadoslav Tsvetkov static const struct csiphy_format_info formats_8x16[] = {
2889936bfbSMartin Dørum { MEDIA_BUS_FMT_UYVY8_1X16, 8 },
2989936bfbSMartin Dørum { MEDIA_BUS_FMT_VYUY8_1X16, 8 },
3089936bfbSMartin Dørum { MEDIA_BUS_FMT_YUYV8_1X16, 8 },
3189936bfbSMartin Dørum { MEDIA_BUS_FMT_YVYU8_1X16, 8 },
32cba3819dSTodor Tomov { MEDIA_BUS_FMT_SBGGR8_1X8, 8 },
33cba3819dSTodor Tomov { MEDIA_BUS_FMT_SGBRG8_1X8, 8 },
34cba3819dSTodor Tomov { MEDIA_BUS_FMT_SGRBG8_1X8, 8 },
35cba3819dSTodor Tomov { MEDIA_BUS_FMT_SRGGB8_1X8, 8 },
36cba3819dSTodor Tomov { MEDIA_BUS_FMT_SBGGR10_1X10, 10 },
37cba3819dSTodor Tomov { MEDIA_BUS_FMT_SGBRG10_1X10, 10 },
38cba3819dSTodor Tomov { MEDIA_BUS_FMT_SGRBG10_1X10, 10 },
39cba3819dSTodor Tomov { MEDIA_BUS_FMT_SRGGB10_1X10, 10 },
40cba3819dSTodor Tomov { MEDIA_BUS_FMT_SBGGR12_1X12, 12 },
41cba3819dSTodor Tomov { MEDIA_BUS_FMT_SGBRG12_1X12, 12 },
42cba3819dSTodor Tomov { MEDIA_BUS_FMT_SGRBG12_1X12, 12 },
43cba3819dSTodor Tomov { MEDIA_BUS_FMT_SRGGB12_1X12, 12 },
44cc8fe073STodor Tomov { MEDIA_BUS_FMT_Y10_1X10, 10 },
45cba3819dSTodor Tomov };
46cba3819dSTodor Tomov
47*e05d1be9SRadoslav Tsvetkov static const struct csiphy_format_info formats_8x96[] = {
4889936bfbSMartin Dørum { MEDIA_BUS_FMT_UYVY8_1X16, 8 },
4989936bfbSMartin Dørum { MEDIA_BUS_FMT_VYUY8_1X16, 8 },
5089936bfbSMartin Dørum { MEDIA_BUS_FMT_YUYV8_1X16, 8 },
5189936bfbSMartin Dørum { MEDIA_BUS_FMT_YVYU8_1X16, 8 },
52cba3819dSTodor Tomov { MEDIA_BUS_FMT_SBGGR8_1X8, 8 },
53cba3819dSTodor Tomov { MEDIA_BUS_FMT_SGBRG8_1X8, 8 },
54cba3819dSTodor Tomov { MEDIA_BUS_FMT_SGRBG8_1X8, 8 },
55cba3819dSTodor Tomov { MEDIA_BUS_FMT_SRGGB8_1X8, 8 },
56cba3819dSTodor Tomov { MEDIA_BUS_FMT_SBGGR10_1X10, 10 },
57cba3819dSTodor Tomov { MEDIA_BUS_FMT_SGBRG10_1X10, 10 },
58cba3819dSTodor Tomov { MEDIA_BUS_FMT_SGRBG10_1X10, 10 },
59cba3819dSTodor Tomov { MEDIA_BUS_FMT_SRGGB10_1X10, 10 },
60cba3819dSTodor Tomov { MEDIA_BUS_FMT_SBGGR12_1X12, 12 },
61cba3819dSTodor Tomov { MEDIA_BUS_FMT_SGBRG12_1X12, 12 },
62cba3819dSTodor Tomov { MEDIA_BUS_FMT_SGRBG12_1X12, 12 },
63cba3819dSTodor Tomov { MEDIA_BUS_FMT_SRGGB12_1X12, 12 },
64f476fb56STodor Tomov { MEDIA_BUS_FMT_SBGGR14_1X14, 14 },
65f476fb56STodor Tomov { MEDIA_BUS_FMT_SGBRG14_1X14, 14 },
66f476fb56STodor Tomov { MEDIA_BUS_FMT_SGRBG14_1X14, 14 },
67f476fb56STodor Tomov { MEDIA_BUS_FMT_SRGGB14_1X14, 14 },
68cc8fe073STodor Tomov { MEDIA_BUS_FMT_Y10_1X10, 10 },
69ec6859b2STodor Tomov };
70ec6859b2STodor Tomov
71*e05d1be9SRadoslav Tsvetkov static const struct csiphy_format_info formats_sdm845[] = {
7289936bfbSMartin Dørum { MEDIA_BUS_FMT_UYVY8_1X16, 8 },
7389936bfbSMartin Dørum { MEDIA_BUS_FMT_VYUY8_1X16, 8 },
7489936bfbSMartin Dørum { MEDIA_BUS_FMT_YUYV8_1X16, 8 },
7589936bfbSMartin Dørum { MEDIA_BUS_FMT_YVYU8_1X16, 8 },
762f8b6719SRobert Foss { MEDIA_BUS_FMT_SBGGR8_1X8, 8 },
772f8b6719SRobert Foss { MEDIA_BUS_FMT_SGBRG8_1X8, 8 },
782f8b6719SRobert Foss { MEDIA_BUS_FMT_SGRBG8_1X8, 8 },
792f8b6719SRobert Foss { MEDIA_BUS_FMT_SRGGB8_1X8, 8 },
802f8b6719SRobert Foss { MEDIA_BUS_FMT_SBGGR10_1X10, 10 },
812f8b6719SRobert Foss { MEDIA_BUS_FMT_SGBRG10_1X10, 10 },
822f8b6719SRobert Foss { MEDIA_BUS_FMT_SGRBG10_1X10, 10 },
832f8b6719SRobert Foss { MEDIA_BUS_FMT_SRGGB10_1X10, 10 },
842f8b6719SRobert Foss { MEDIA_BUS_FMT_SBGGR12_1X12, 12 },
852f8b6719SRobert Foss { MEDIA_BUS_FMT_SGBRG12_1X12, 12 },
862f8b6719SRobert Foss { MEDIA_BUS_FMT_SGRBG12_1X12, 12 },
872f8b6719SRobert Foss { MEDIA_BUS_FMT_SRGGB12_1X12, 12 },
882f8b6719SRobert Foss { MEDIA_BUS_FMT_SBGGR14_1X14, 14 },
892f8b6719SRobert Foss { MEDIA_BUS_FMT_SGBRG14_1X14, 14 },
902f8b6719SRobert Foss { MEDIA_BUS_FMT_SGRBG14_1X14, 14 },
912f8b6719SRobert Foss { MEDIA_BUS_FMT_SRGGB14_1X14, 14 },
92e53d6608SJonathan Marek { MEDIA_BUS_FMT_Y8_1X8, 8 },
932f8b6719SRobert Foss { MEDIA_BUS_FMT_Y10_1X10, 10 },
942f8b6719SRobert Foss };
952f8b6719SRobert Foss
96*e05d1be9SRadoslav Tsvetkov const struct csiphy_formats csiphy_formats_8x16 = {
97*e05d1be9SRadoslav Tsvetkov .nformats = ARRAY_SIZE(formats_8x16),
98*e05d1be9SRadoslav Tsvetkov .formats = formats_8x16
99*e05d1be9SRadoslav Tsvetkov };
100*e05d1be9SRadoslav Tsvetkov
101*e05d1be9SRadoslav Tsvetkov const struct csiphy_formats csiphy_formats_8x96 = {
102*e05d1be9SRadoslav Tsvetkov .nformats = ARRAY_SIZE(formats_8x96),
103*e05d1be9SRadoslav Tsvetkov .formats = formats_8x96
104*e05d1be9SRadoslav Tsvetkov };
105*e05d1be9SRadoslav Tsvetkov
106*e05d1be9SRadoslav Tsvetkov const struct csiphy_formats csiphy_formats_sdm845 = {
107*e05d1be9SRadoslav Tsvetkov .nformats = ARRAY_SIZE(formats_sdm845),
108*e05d1be9SRadoslav Tsvetkov .formats = formats_sdm845
109*e05d1be9SRadoslav Tsvetkov };
110*e05d1be9SRadoslav Tsvetkov
111ec6859b2STodor Tomov /*
112ec6859b2STodor Tomov * csiphy_get_bpp - map media bus format to bits per pixel
113cba3819dSTodor Tomov * @formats: supported media bus formats array
114cba3819dSTodor Tomov * @nformats: size of @formats array
115ec6859b2STodor Tomov * @code: media bus format code
116ec6859b2STodor Tomov *
117ec6859b2STodor Tomov * Return number of bits per pixel
118ec6859b2STodor Tomov */
csiphy_get_bpp(const struct csiphy_format_info * formats,unsigned int nformats,u32 code)119*e05d1be9SRadoslav Tsvetkov static u8 csiphy_get_bpp(const struct csiphy_format_info *formats,
120cba3819dSTodor Tomov unsigned int nformats, u32 code)
121ec6859b2STodor Tomov {
122ec6859b2STodor Tomov unsigned int i;
123ec6859b2STodor Tomov
124cba3819dSTodor Tomov for (i = 0; i < nformats; i++)
125cba3819dSTodor Tomov if (code == formats[i].code)
126cba3819dSTodor Tomov return formats[i].bpp;
127ec6859b2STodor Tomov
128ec6859b2STodor Tomov WARN(1, "Unknown format\n");
129ec6859b2STodor Tomov
130cba3819dSTodor Tomov return formats[0].bpp;
131ec6859b2STodor Tomov }
132ec6859b2STodor Tomov
133ec6859b2STodor Tomov /*
134ec6859b2STodor Tomov * csiphy_set_clock_rates - Calculate and set clock rates on CSIPHY module
135ec6859b2STodor Tomov * @csiphy: CSIPHY device
136ec6859b2STodor Tomov */
csiphy_set_clock_rates(struct csiphy_device * csiphy)137ec6859b2STodor Tomov static int csiphy_set_clock_rates(struct csiphy_device *csiphy)
138ec6859b2STodor Tomov {
1399c3e59deSTodor Tomov struct device *dev = csiphy->camss->dev;
14078c2cc28SAndrey Konovalov s64 link_freq;
141ec6859b2STodor Tomov int i, j;
142ec6859b2STodor Tomov int ret;
143ec6859b2STodor Tomov
144*e05d1be9SRadoslav Tsvetkov u8 bpp = csiphy_get_bpp(csiphy->res->formats->formats, csiphy->res->formats->nformats,
14578c2cc28SAndrey Konovalov csiphy->fmt[MSM_CSIPHY_PAD_SINK].code);
14678c2cc28SAndrey Konovalov u8 num_lanes = csiphy->cfg.csi2->lane_cfg.num_data;
14778c2cc28SAndrey Konovalov
14878c2cc28SAndrey Konovalov link_freq = camss_get_link_freq(&csiphy->subdev.entity, bpp, num_lanes);
14978c2cc28SAndrey Konovalov if (link_freq < 0)
15078c2cc28SAndrey Konovalov link_freq = 0;
151ec6859b2STodor Tomov
152ec6859b2STodor Tomov for (i = 0; i < csiphy->nclocks; i++) {
153ec6859b2STodor Tomov struct camss_clock *clock = &csiphy->clock[i];
154ec6859b2STodor Tomov
1554863b93cSAngeloGioacchino Del Regno if (csiphy->rate_set[i]) {
15678c2cc28SAndrey Konovalov u64 min_rate = link_freq / 4;
157ec6859b2STodor Tomov long round_rate;
158ec6859b2STodor Tomov
159ec6859b2STodor Tomov camss_add_clock_margin(&min_rate);
160ec6859b2STodor Tomov
161ec6859b2STodor Tomov for (j = 0; j < clock->nfreqs; j++)
162ec6859b2STodor Tomov if (min_rate < clock->freq[j])
163ec6859b2STodor Tomov break;
164ec6859b2STodor Tomov
165ec6859b2STodor Tomov if (j == clock->nfreqs) {
166ec6859b2STodor Tomov dev_err(dev,
167ec6859b2STodor Tomov "Pixel clock is too high for CSIPHY\n");
168ec6859b2STodor Tomov return -EINVAL;
169ec6859b2STodor Tomov }
170ec6859b2STodor Tomov
171ec6859b2STodor Tomov /* if sensor pixel clock is not available */
172ec6859b2STodor Tomov /* set highest possible CSIPHY clock rate */
173ec6859b2STodor Tomov if (min_rate == 0)
174ec6859b2STodor Tomov j = clock->nfreqs - 1;
175ec6859b2STodor Tomov
176ec6859b2STodor Tomov round_rate = clk_round_rate(clock->clk, clock->freq[j]);
177ec6859b2STodor Tomov if (round_rate < 0) {
178ec6859b2STodor Tomov dev_err(dev, "clk round rate failed: %ld\n",
179ec6859b2STodor Tomov round_rate);
180ec6859b2STodor Tomov return -EINVAL;
181ec6859b2STodor Tomov }
182ec6859b2STodor Tomov
183ec6859b2STodor Tomov csiphy->timer_clk_rate = round_rate;
184ec6859b2STodor Tomov
185ec6859b2STodor Tomov ret = clk_set_rate(clock->clk, csiphy->timer_clk_rate);
186ec6859b2STodor Tomov if (ret < 0) {
187ec6859b2STodor Tomov dev_err(dev, "clk set rate failed: %d\n", ret);
188ec6859b2STodor Tomov return ret;
189ec6859b2STodor Tomov }
190ec6859b2STodor Tomov }
191ec6859b2STodor Tomov }
192ec6859b2STodor Tomov
193ec6859b2STodor Tomov return 0;
194ec6859b2STodor Tomov }
195ec6859b2STodor Tomov
196ec6859b2STodor Tomov /*
197ec6859b2STodor Tomov * csiphy_set_power - Power on/off CSIPHY module
198ec6859b2STodor Tomov * @sd: CSIPHY V4L2 subdevice
199ec6859b2STodor Tomov * @on: Requested power state
200ec6859b2STodor Tomov *
201ec6859b2STodor Tomov * Return 0 on success or a negative error code otherwise
202ec6859b2STodor Tomov */
csiphy_set_power(struct v4l2_subdev * sd,int on)203ec6859b2STodor Tomov static int csiphy_set_power(struct v4l2_subdev *sd, int on)
204ec6859b2STodor Tomov {
205ec6859b2STodor Tomov struct csiphy_device *csiphy = v4l2_get_subdevdata(sd);
2069c3e59deSTodor Tomov struct device *dev = csiphy->camss->dev;
207ec6859b2STodor Tomov
208ec6859b2STodor Tomov if (on) {
209ec6859b2STodor Tomov int ret;
210ec6859b2STodor Tomov
21109dfb36cSMauro Carvalho Chehab ret = pm_runtime_resume_and_get(dev);
21209dfb36cSMauro Carvalho Chehab if (ret < 0)
213ec6859b2STodor Tomov return ret;
214ec6859b2STodor Tomov
21502afa816STodor Tomov ret = csiphy_set_clock_rates(csiphy);
21602afa816STodor Tomov if (ret < 0) {
21702afa816STodor Tomov pm_runtime_put_sync(dev);
218ec6859b2STodor Tomov return ret;
21902afa816STodor Tomov }
22002afa816STodor Tomov
22102afa816STodor Tomov ret = camss_enable_clocks(csiphy->nclocks, csiphy->clock, dev);
22202afa816STodor Tomov if (ret < 0) {
22302afa816STodor Tomov pm_runtime_put_sync(dev);
22402afa816STodor Tomov return ret;
22502afa816STodor Tomov }
226ec6859b2STodor Tomov
227ec6859b2STodor Tomov enable_irq(csiphy->irq);
228ec6859b2STodor Tomov
229ae44829aSRadoslav Tsvetkov csiphy->res->hw_ops->reset(csiphy);
230ec6859b2STodor Tomov
231ae44829aSRadoslav Tsvetkov csiphy->res->hw_ops->hw_version_read(csiphy, dev);
232ec6859b2STodor Tomov } else {
233ec6859b2STodor Tomov disable_irq(csiphy->irq);
234ec6859b2STodor Tomov
235ec6859b2STodor Tomov camss_disable_clocks(csiphy->nclocks, csiphy->clock);
23602afa816STodor Tomov
23702afa816STodor Tomov pm_runtime_put_sync(dev);
238ec6859b2STodor Tomov }
239ec6859b2STodor Tomov
240ec6859b2STodor Tomov return 0;
241ec6859b2STodor Tomov }
242ec6859b2STodor Tomov
243ec6859b2STodor Tomov /*
244ec6859b2STodor Tomov * csiphy_stream_on - Enable streaming on CSIPHY module
245ec6859b2STodor Tomov * @csiphy: CSIPHY device
246ec6859b2STodor Tomov *
247ec6859b2STodor Tomov * Helper function to enable streaming on CSIPHY module.
248ec6859b2STodor Tomov * Main configuration of CSIPHY module is also done here.
249ec6859b2STodor Tomov *
250ec6859b2STodor Tomov * Return 0 on success or a negative error code otherwise
251ec6859b2STodor Tomov */
csiphy_stream_on(struct csiphy_device * csiphy)252ec6859b2STodor Tomov static int csiphy_stream_on(struct csiphy_device *csiphy)
253ec6859b2STodor Tomov {
254ec6859b2STodor Tomov struct csiphy_config *cfg = &csiphy->cfg;
25578c2cc28SAndrey Konovalov s64 link_freq;
256ae44829aSRadoslav Tsvetkov u8 lane_mask = csiphy->res->hw_ops->get_lane_mask(&cfg->csi2->lane_cfg);
257*e05d1be9SRadoslav Tsvetkov u8 bpp = csiphy_get_bpp(csiphy->res->formats->formats, csiphy->res->formats->nformats,
258cba3819dSTodor Tomov csiphy->fmt[MSM_CSIPHY_PAD_SINK].code);
25978c2cc28SAndrey Konovalov u8 num_lanes = csiphy->cfg.csi2->lane_cfg.num_data;
260ec6859b2STodor Tomov u8 val;
261ec6859b2STodor Tomov
26278c2cc28SAndrey Konovalov link_freq = camss_get_link_freq(&csiphy->subdev.entity, bpp, num_lanes);
26378c2cc28SAndrey Konovalov
26478c2cc28SAndrey Konovalov if (link_freq < 0) {
265516e8f0fSTodor Tomov dev_err(csiphy->camss->dev,
26678c2cc28SAndrey Konovalov "Cannot get CSI2 transmitter's link frequency\n");
267516e8f0fSTodor Tomov return -EINVAL;
268516e8f0fSTodor Tomov }
269ec6859b2STodor Tomov
2702f8b6719SRobert Foss if (csiphy->base_clk_mux) {
271ec6859b2STodor Tomov val = readl_relaxed(csiphy->base_clk_mux);
272ec6859b2STodor Tomov if (cfg->combo_mode && (lane_mask & 0x18) == 0x18) {
273ec6859b2STodor Tomov val &= ~0xf0;
274ec6859b2STodor Tomov val |= cfg->csid_id << 4;
275ec6859b2STodor Tomov } else {
276ec6859b2STodor Tomov val &= ~0xf;
277ec6859b2STodor Tomov val |= cfg->csid_id;
278ec6859b2STodor Tomov }
279ec6859b2STodor Tomov writel_relaxed(val, csiphy->base_clk_mux);
2802f8b6719SRobert Foss
2812f8b6719SRobert Foss /* Enforce reg write ordering between clk mux & lane enabling */
2825ba913b3STodor Tomov wmb();
2832f8b6719SRobert Foss }
284ec6859b2STodor Tomov
285ae44829aSRadoslav Tsvetkov csiphy->res->hw_ops->lanes_enable(csiphy, cfg, link_freq, lane_mask);
286ec6859b2STodor Tomov
287ec6859b2STodor Tomov return 0;
288ec6859b2STodor Tomov }
289ec6859b2STodor Tomov
290ec6859b2STodor Tomov /*
291ec6859b2STodor Tomov * csiphy_stream_off - Disable streaming on CSIPHY module
292ec6859b2STodor Tomov * @csiphy: CSIPHY device
293ec6859b2STodor Tomov *
294ec6859b2STodor Tomov * Helper function to disable streaming on CSIPHY module
295ec6859b2STodor Tomov */
csiphy_stream_off(struct csiphy_device * csiphy)296ec6859b2STodor Tomov static void csiphy_stream_off(struct csiphy_device *csiphy)
297ec6859b2STodor Tomov {
298ae44829aSRadoslav Tsvetkov csiphy->res->hw_ops->lanes_disable(csiphy, &csiphy->cfg);
299ec6859b2STodor Tomov }
300ec6859b2STodor Tomov
301ec6859b2STodor Tomov
302ec6859b2STodor Tomov /*
303ec6859b2STodor Tomov * csiphy_set_stream - Enable/disable streaming on CSIPHY module
304ec6859b2STodor Tomov * @sd: CSIPHY V4L2 subdevice
305ec6859b2STodor Tomov * @enable: Requested streaming state
306ec6859b2STodor Tomov *
307ec6859b2STodor Tomov * Return 0 on success or a negative error code otherwise
308ec6859b2STodor Tomov */
csiphy_set_stream(struct v4l2_subdev * sd,int enable)309ec6859b2STodor Tomov static int csiphy_set_stream(struct v4l2_subdev *sd, int enable)
310ec6859b2STodor Tomov {
311ec6859b2STodor Tomov struct csiphy_device *csiphy = v4l2_get_subdevdata(sd);
312ec6859b2STodor Tomov int ret = 0;
313ec6859b2STodor Tomov
314ec6859b2STodor Tomov if (enable)
315ec6859b2STodor Tomov ret = csiphy_stream_on(csiphy);
316ec6859b2STodor Tomov else
317ec6859b2STodor Tomov csiphy_stream_off(csiphy);
318ec6859b2STodor Tomov
319ec6859b2STodor Tomov return ret;
320ec6859b2STodor Tomov }
321ec6859b2STodor Tomov
322ec6859b2STodor Tomov /*
323ec6859b2STodor Tomov * __csiphy_get_format - Get pointer to format structure
324ec6859b2STodor Tomov * @csiphy: CSIPHY device
325c1d96814SLaurent Pinchart * @sd_state: V4L2 subdev state
326ec6859b2STodor Tomov * @pad: pad from which format is requested
327ec6859b2STodor Tomov * @which: TRY or ACTIVE format
328ec6859b2STodor Tomov *
329ec6859b2STodor Tomov * Return pointer to TRY or ACTIVE format structure
330ec6859b2STodor Tomov */
331ec6859b2STodor Tomov static struct v4l2_mbus_framefmt *
__csiphy_get_format(struct csiphy_device * csiphy,struct v4l2_subdev_state * sd_state,unsigned int pad,enum v4l2_subdev_format_whence which)332ec6859b2STodor Tomov __csiphy_get_format(struct csiphy_device *csiphy,
3330d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state,
334ec6859b2STodor Tomov unsigned int pad,
335ec6859b2STodor Tomov enum v4l2_subdev_format_whence which)
336ec6859b2STodor Tomov {
337ec6859b2STodor Tomov if (which == V4L2_SUBDEV_FORMAT_TRY)
338bc0e8d91SSakari Ailus return v4l2_subdev_state_get_format(sd_state, pad);
339ec6859b2STodor Tomov
340ec6859b2STodor Tomov return &csiphy->fmt[pad];
341ec6859b2STodor Tomov }
342ec6859b2STodor Tomov
343ec6859b2STodor Tomov /*
344ec6859b2STodor Tomov * csiphy_try_format - Handle try format by pad subdev method
345ec6859b2STodor Tomov * @csiphy: CSIPHY device
346c1d96814SLaurent Pinchart * @sd_state: V4L2 subdev state
347ec6859b2STodor Tomov * @pad: pad on which format is requested
348ec6859b2STodor Tomov * @fmt: pointer to v4l2 format structure
349ec6859b2STodor Tomov * @which: wanted subdev format
350ec6859b2STodor Tomov */
csiphy_try_format(struct csiphy_device * csiphy,struct v4l2_subdev_state * sd_state,unsigned int pad,struct v4l2_mbus_framefmt * fmt,enum v4l2_subdev_format_whence which)351ec6859b2STodor Tomov static void csiphy_try_format(struct csiphy_device *csiphy,
3520d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state,
353ec6859b2STodor Tomov unsigned int pad,
354ec6859b2STodor Tomov struct v4l2_mbus_framefmt *fmt,
355ec6859b2STodor Tomov enum v4l2_subdev_format_whence which)
356ec6859b2STodor Tomov {
357ec6859b2STodor Tomov unsigned int i;
358ec6859b2STodor Tomov
359ec6859b2STodor Tomov switch (pad) {
360ec6859b2STodor Tomov case MSM_CSIPHY_PAD_SINK:
361ec6859b2STodor Tomov /* Set format on sink pad */
362ec6859b2STodor Tomov
363*e05d1be9SRadoslav Tsvetkov for (i = 0; i < csiphy->res->formats->nformats; i++)
364*e05d1be9SRadoslav Tsvetkov if (fmt->code == csiphy->res->formats->formats[i].code)
365ec6859b2STodor Tomov break;
366ec6859b2STodor Tomov
367ec6859b2STodor Tomov /* If not found, use UYVY as default */
368*e05d1be9SRadoslav Tsvetkov if (i >= csiphy->res->formats->nformats)
36989936bfbSMartin Dørum fmt->code = MEDIA_BUS_FMT_UYVY8_1X16;
370ec6859b2STodor Tomov
371ec6859b2STodor Tomov fmt->width = clamp_t(u32, fmt->width, 1, 8191);
372ec6859b2STodor Tomov fmt->height = clamp_t(u32, fmt->height, 1, 8191);
373ec6859b2STodor Tomov
374ec6859b2STodor Tomov fmt->field = V4L2_FIELD_NONE;
375ec6859b2STodor Tomov fmt->colorspace = V4L2_COLORSPACE_SRGB;
376ec6859b2STodor Tomov
377ec6859b2STodor Tomov break;
378ec6859b2STodor Tomov
379ec6859b2STodor Tomov case MSM_CSIPHY_PAD_SRC:
380ec6859b2STodor Tomov /* Set and return a format same as sink pad */
381ec6859b2STodor Tomov
3820d346d2aSTomi Valkeinen *fmt = *__csiphy_get_format(csiphy, sd_state,
3830d346d2aSTomi Valkeinen MSM_CSID_PAD_SINK,
384ec6859b2STodor Tomov which);
385ec6859b2STodor Tomov
386ec6859b2STodor Tomov break;
387ec6859b2STodor Tomov }
388ec6859b2STodor Tomov }
389ec6859b2STodor Tomov
390ec6859b2STodor Tomov /*
391ec6859b2STodor Tomov * csiphy_enum_mbus_code - Handle pixel format enumeration
392ec6859b2STodor Tomov * @sd: CSIPHY V4L2 subdevice
393c1d96814SLaurent Pinchart * @sd_state: V4L2 subdev state
394ec6859b2STodor Tomov * @code: pointer to v4l2_subdev_mbus_code_enum structure
395ec6859b2STodor Tomov * return -EINVAL or zero on success
396ec6859b2STodor Tomov */
csiphy_enum_mbus_code(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_mbus_code_enum * code)397ec6859b2STodor Tomov static int csiphy_enum_mbus_code(struct v4l2_subdev *sd,
3980d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state,
399ec6859b2STodor Tomov struct v4l2_subdev_mbus_code_enum *code)
400ec6859b2STodor Tomov {
401ec6859b2STodor Tomov struct csiphy_device *csiphy = v4l2_get_subdevdata(sd);
402ec6859b2STodor Tomov struct v4l2_mbus_framefmt *format;
403ec6859b2STodor Tomov
404ec6859b2STodor Tomov if (code->pad == MSM_CSIPHY_PAD_SINK) {
405*e05d1be9SRadoslav Tsvetkov if (code->index >= csiphy->res->formats->nformats)
406ec6859b2STodor Tomov return -EINVAL;
407ec6859b2STodor Tomov
408*e05d1be9SRadoslav Tsvetkov code->code = csiphy->res->formats->formats[code->index].code;
409ec6859b2STodor Tomov } else {
410ec6859b2STodor Tomov if (code->index > 0)
411ec6859b2STodor Tomov return -EINVAL;
412ec6859b2STodor Tomov
4130d346d2aSTomi Valkeinen format = __csiphy_get_format(csiphy, sd_state,
4140d346d2aSTomi Valkeinen MSM_CSIPHY_PAD_SINK,
415ec6859b2STodor Tomov code->which);
416ec6859b2STodor Tomov
417ec6859b2STodor Tomov code->code = format->code;
418ec6859b2STodor Tomov }
419ec6859b2STodor Tomov
420ec6859b2STodor Tomov return 0;
421ec6859b2STodor Tomov }
422ec6859b2STodor Tomov
423ec6859b2STodor Tomov /*
424ec6859b2STodor Tomov * csiphy_enum_frame_size - Handle frame size enumeration
425ec6859b2STodor Tomov * @sd: CSIPHY V4L2 subdevice
426c1d96814SLaurent Pinchart * @sd_state: V4L2 subdev state
427ec6859b2STodor Tomov * @fse: pointer to v4l2_subdev_frame_size_enum structure
428ec6859b2STodor Tomov * return -EINVAL or zero on success
429ec6859b2STodor Tomov */
csiphy_enum_frame_size(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_frame_size_enum * fse)430ec6859b2STodor Tomov static int csiphy_enum_frame_size(struct v4l2_subdev *sd,
4310d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state,
432ec6859b2STodor Tomov struct v4l2_subdev_frame_size_enum *fse)
433ec6859b2STodor Tomov {
434ec6859b2STodor Tomov struct csiphy_device *csiphy = v4l2_get_subdevdata(sd);
435ec6859b2STodor Tomov struct v4l2_mbus_framefmt format;
436ec6859b2STodor Tomov
437ec6859b2STodor Tomov if (fse->index != 0)
438ec6859b2STodor Tomov return -EINVAL;
439ec6859b2STodor Tomov
440ec6859b2STodor Tomov format.code = fse->code;
441ec6859b2STodor Tomov format.width = 1;
442ec6859b2STodor Tomov format.height = 1;
4430d346d2aSTomi Valkeinen csiphy_try_format(csiphy, sd_state, fse->pad, &format, fse->which);
444ec6859b2STodor Tomov fse->min_width = format.width;
445ec6859b2STodor Tomov fse->min_height = format.height;
446ec6859b2STodor Tomov
447ec6859b2STodor Tomov if (format.code != fse->code)
448ec6859b2STodor Tomov return -EINVAL;
449ec6859b2STodor Tomov
450ec6859b2STodor Tomov format.code = fse->code;
451ec6859b2STodor Tomov format.width = -1;
452ec6859b2STodor Tomov format.height = -1;
4530d346d2aSTomi Valkeinen csiphy_try_format(csiphy, sd_state, fse->pad, &format, fse->which);
454ec6859b2STodor Tomov fse->max_width = format.width;
455ec6859b2STodor Tomov fse->max_height = format.height;
456ec6859b2STodor Tomov
457ec6859b2STodor Tomov return 0;
458ec6859b2STodor Tomov }
459ec6859b2STodor Tomov
460ec6859b2STodor Tomov /*
461ec6859b2STodor Tomov * csiphy_get_format - Handle get format by pads subdev method
462ec6859b2STodor Tomov * @sd: CSIPHY V4L2 subdevice
463c1d96814SLaurent Pinchart * @sd_state: V4L2 subdev state
464ec6859b2STodor Tomov * @fmt: pointer to v4l2 subdev format structure
465ec6859b2STodor Tomov *
466ec6859b2STodor Tomov * Return -EINVAL or zero on success
467ec6859b2STodor Tomov */
csiphy_get_format(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_format * fmt)468ec6859b2STodor Tomov static int csiphy_get_format(struct v4l2_subdev *sd,
4690d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state,
470ec6859b2STodor Tomov struct v4l2_subdev_format *fmt)
471ec6859b2STodor Tomov {
472ec6859b2STodor Tomov struct csiphy_device *csiphy = v4l2_get_subdevdata(sd);
473ec6859b2STodor Tomov struct v4l2_mbus_framefmt *format;
474ec6859b2STodor Tomov
4750d346d2aSTomi Valkeinen format = __csiphy_get_format(csiphy, sd_state, fmt->pad, fmt->which);
476ec6859b2STodor Tomov if (format == NULL)
477ec6859b2STodor Tomov return -EINVAL;
478ec6859b2STodor Tomov
479ec6859b2STodor Tomov fmt->format = *format;
480ec6859b2STodor Tomov
481ec6859b2STodor Tomov return 0;
482ec6859b2STodor Tomov }
483ec6859b2STodor Tomov
484ec6859b2STodor Tomov /*
485ec6859b2STodor Tomov * csiphy_set_format - Handle set format by pads subdev method
486ec6859b2STodor Tomov * @sd: CSIPHY V4L2 subdevice
487c1d96814SLaurent Pinchart * @sd_state: V4L2 subdev state
488ec6859b2STodor Tomov * @fmt: pointer to v4l2 subdev format structure
489ec6859b2STodor Tomov *
490ec6859b2STodor Tomov * Return -EINVAL or zero on success
491ec6859b2STodor Tomov */
csiphy_set_format(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_format * fmt)492ec6859b2STodor Tomov static int csiphy_set_format(struct v4l2_subdev *sd,
4930d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state,
494ec6859b2STodor Tomov struct v4l2_subdev_format *fmt)
495ec6859b2STodor Tomov {
496ec6859b2STodor Tomov struct csiphy_device *csiphy = v4l2_get_subdevdata(sd);
497ec6859b2STodor Tomov struct v4l2_mbus_framefmt *format;
498ec6859b2STodor Tomov
4990d346d2aSTomi Valkeinen format = __csiphy_get_format(csiphy, sd_state, fmt->pad, fmt->which);
500ec6859b2STodor Tomov if (format == NULL)
501ec6859b2STodor Tomov return -EINVAL;
502ec6859b2STodor Tomov
5030d346d2aSTomi Valkeinen csiphy_try_format(csiphy, sd_state, fmt->pad, &fmt->format,
5040d346d2aSTomi Valkeinen fmt->which);
505ec6859b2STodor Tomov *format = fmt->format;
506ec6859b2STodor Tomov
507ec6859b2STodor Tomov /* Propagate the format from sink to source */
508ec6859b2STodor Tomov if (fmt->pad == MSM_CSIPHY_PAD_SINK) {
5090d346d2aSTomi Valkeinen format = __csiphy_get_format(csiphy, sd_state,
5100d346d2aSTomi Valkeinen MSM_CSIPHY_PAD_SRC,
511ec6859b2STodor Tomov fmt->which);
512ec6859b2STodor Tomov
513ec6859b2STodor Tomov *format = fmt->format;
5140d346d2aSTomi Valkeinen csiphy_try_format(csiphy, sd_state, MSM_CSIPHY_PAD_SRC,
5150d346d2aSTomi Valkeinen format,
516ec6859b2STodor Tomov fmt->which);
517ec6859b2STodor Tomov }
518ec6859b2STodor Tomov
519ec6859b2STodor Tomov return 0;
520ec6859b2STodor Tomov }
521ec6859b2STodor Tomov
522ec6859b2STodor Tomov /*
523ec6859b2STodor Tomov * csiphy_init_formats - Initialize formats on all pads
524ec6859b2STodor Tomov * @sd: CSIPHY V4L2 subdevice
525ec6859b2STodor Tomov * @fh: V4L2 subdev file handle
526ec6859b2STodor Tomov *
527ec6859b2STodor Tomov * Initialize all pad formats with default values.
528ec6859b2STodor Tomov *
529ec6859b2STodor Tomov * Return 0 on success or a negative error code otherwise
530ec6859b2STodor Tomov */
csiphy_init_formats(struct v4l2_subdev * sd,struct v4l2_subdev_fh * fh)531ec6859b2STodor Tomov static int csiphy_init_formats(struct v4l2_subdev *sd,
532ec6859b2STodor Tomov struct v4l2_subdev_fh *fh)
533ec6859b2STodor Tomov {
534ec6859b2STodor Tomov struct v4l2_subdev_format format = {
535ec6859b2STodor Tomov .pad = MSM_CSIPHY_PAD_SINK,
536ec6859b2STodor Tomov .which = fh ? V4L2_SUBDEV_FORMAT_TRY :
537ec6859b2STodor Tomov V4L2_SUBDEV_FORMAT_ACTIVE,
538ec6859b2STodor Tomov .format = {
53989936bfbSMartin Dørum .code = MEDIA_BUS_FMT_UYVY8_1X16,
540ec6859b2STodor Tomov .width = 1920,
541ec6859b2STodor Tomov .height = 1080
542ec6859b2STodor Tomov }
543ec6859b2STodor Tomov };
544ec6859b2STodor Tomov
5450d346d2aSTomi Valkeinen return csiphy_set_format(sd, fh ? fh->state : NULL, &format);
546ec6859b2STodor Tomov }
547ec6859b2STodor Tomov
csiphy_match_clock_name(const char * clock_name,const char * format,int index)5480727615fSBryan O'Donoghue static bool csiphy_match_clock_name(const char *clock_name, const char *format,
5490727615fSBryan O'Donoghue int index)
5500727615fSBryan O'Donoghue {
5510727615fSBryan O'Donoghue char name[16]; /* csiphyXXX_timer\0 */
5520727615fSBryan O'Donoghue
5530727615fSBryan O'Donoghue snprintf(name, sizeof(name), format, index);
5540727615fSBryan O'Donoghue return !strcmp(clock_name, name);
5550727615fSBryan O'Donoghue }
5560727615fSBryan O'Donoghue
557ec6859b2STodor Tomov /*
558ec6859b2STodor Tomov * msm_csiphy_subdev_init - Initialize CSIPHY device structure and resources
559ec6859b2STodor Tomov * @csiphy: CSIPHY device
560ec6859b2STodor Tomov * @res: CSIPHY module resources table
561ec6859b2STodor Tomov * @id: CSIPHY module id
562ec6859b2STodor Tomov *
563ec6859b2STodor Tomov * Return 0 on success or a negative error code otherwise
564ec6859b2STodor Tomov */
msm_csiphy_subdev_init(struct camss * camss,struct csiphy_device * csiphy,const struct camss_subdev_resources * res,u8 id)5659c3e59deSTodor Tomov int msm_csiphy_subdev_init(struct camss *camss,
5669c3e59deSTodor Tomov struct csiphy_device *csiphy,
5671643b787SBryan O'Donoghue const struct camss_subdev_resources *res, u8 id)
568ec6859b2STodor Tomov {
5699c3e59deSTodor Tomov struct device *dev = camss->dev;
570ec6859b2STodor Tomov struct platform_device *pdev = to_platform_device(dev);
5710727615fSBryan O'Donoghue int i, j, k;
572ec6859b2STodor Tomov int ret;
573ec6859b2STodor Tomov
5749c3e59deSTodor Tomov csiphy->camss = camss;
575ec6859b2STodor Tomov csiphy->id = id;
576ec6859b2STodor Tomov csiphy->cfg.combo_mode = 0;
577ae44829aSRadoslav Tsvetkov csiphy->res = &res->csiphy;
578ec6859b2STodor Tomov
579ec6859b2STodor Tomov /* Memory */
580ec6859b2STodor Tomov
581414e0a64Sdingsenjie csiphy->base = devm_platform_ioremap_resource_byname(pdev, res->reg[0]);
5826fe1152aSYang Yingliang if (IS_ERR(csiphy->base))
583ec6859b2STodor Tomov return PTR_ERR(csiphy->base);
584ec6859b2STodor Tomov
5855900b051SBryan O'Donoghue if (camss->res->version == CAMSS_8x16 ||
5865900b051SBryan O'Donoghue camss->res->version == CAMSS_8x96) {
587414e0a64Sdingsenjie csiphy->base_clk_mux =
588414e0a64Sdingsenjie devm_platform_ioremap_resource_byname(pdev, res->reg[1]);
5896fe1152aSYang Yingliang if (IS_ERR(csiphy->base_clk_mux))
590ec6859b2STodor Tomov return PTR_ERR(csiphy->base_clk_mux);
5912f8b6719SRobert Foss } else {
5922f8b6719SRobert Foss csiphy->base_clk_mux = NULL;
5932f8b6719SRobert Foss }
594ec6859b2STodor Tomov
595ec6859b2STodor Tomov /* Interrupt */
596ec6859b2STodor Tomov
597b416be3aSLad Prabhakar ret = platform_get_irq_byname(pdev, res->interrupt[0]);
598b416be3aSLad Prabhakar if (ret < 0)
599b416be3aSLad Prabhakar return ret;
600ec6859b2STodor Tomov
601b416be3aSLad Prabhakar csiphy->irq = ret;
602ec6859b2STodor Tomov snprintf(csiphy->irq_name, sizeof(csiphy->irq_name), "%s_%s%d",
603ec6859b2STodor Tomov dev_name(dev), MSM_CSIPHY_NAME, csiphy->id);
604516e8f0fSTodor Tomov
605ae44829aSRadoslav Tsvetkov ret = devm_request_irq(dev, csiphy->irq, csiphy->res->hw_ops->isr,
60614480e8dSTian Tao IRQF_TRIGGER_RISING | IRQF_NO_AUTOEN,
60714480e8dSTian Tao csiphy->irq_name, csiphy);
608ec6859b2STodor Tomov if (ret < 0) {
609ec6859b2STodor Tomov dev_err(dev, "request_irq failed: %d\n", ret);
610ec6859b2STodor Tomov return ret;
611ec6859b2STodor Tomov }
612ec6859b2STodor Tomov
613ec6859b2STodor Tomov /* Clocks */
614ec6859b2STodor Tomov
615ec6859b2STodor Tomov csiphy->nclocks = 0;
616ec6859b2STodor Tomov while (res->clock[csiphy->nclocks])
617ec6859b2STodor Tomov csiphy->nclocks++;
618ec6859b2STodor Tomov
619ec6859b2STodor Tomov csiphy->clock = devm_kcalloc(dev,
620ec6859b2STodor Tomov csiphy->nclocks, sizeof(*csiphy->clock),
621ec6859b2STodor Tomov GFP_KERNEL);
622ec6859b2STodor Tomov if (!csiphy->clock)
623ec6859b2STodor Tomov return -ENOMEM;
624ec6859b2STodor Tomov
6254863b93cSAngeloGioacchino Del Regno csiphy->rate_set = devm_kcalloc(dev,
6264863b93cSAngeloGioacchino Del Regno csiphy->nclocks,
6274863b93cSAngeloGioacchino Del Regno sizeof(*csiphy->rate_set),
6284863b93cSAngeloGioacchino Del Regno GFP_KERNEL);
6294863b93cSAngeloGioacchino Del Regno if (!csiphy->rate_set)
6304863b93cSAngeloGioacchino Del Regno return -ENOMEM;
6314863b93cSAngeloGioacchino Del Regno
632ec6859b2STodor Tomov for (i = 0; i < csiphy->nclocks; i++) {
633ec6859b2STodor Tomov struct camss_clock *clock = &csiphy->clock[i];
634ec6859b2STodor Tomov
635ec6859b2STodor Tomov clock->clk = devm_clk_get(dev, res->clock[i]);
636ec6859b2STodor Tomov if (IS_ERR(clock->clk))
637ec6859b2STodor Tomov return PTR_ERR(clock->clk);
638ec6859b2STodor Tomov
639ec6859b2STodor Tomov clock->name = res->clock[i];
640ec6859b2STodor Tomov
641ec6859b2STodor Tomov clock->nfreqs = 0;
642ec6859b2STodor Tomov while (res->clock_rate[i][clock->nfreqs])
643ec6859b2STodor Tomov clock->nfreqs++;
644ec6859b2STodor Tomov
645ec6859b2STodor Tomov if (!clock->nfreqs) {
646ec6859b2STodor Tomov clock->freq = NULL;
647ec6859b2STodor Tomov continue;
648ec6859b2STodor Tomov }
649ec6859b2STodor Tomov
650ec6859b2STodor Tomov clock->freq = devm_kcalloc(dev,
651ec6859b2STodor Tomov clock->nfreqs,
652ec6859b2STodor Tomov sizeof(*clock->freq),
653ec6859b2STodor Tomov GFP_KERNEL);
654ec6859b2STodor Tomov if (!clock->freq)
655ec6859b2STodor Tomov return -ENOMEM;
656ec6859b2STodor Tomov
657ec6859b2STodor Tomov for (j = 0; j < clock->nfreqs; j++)
658ec6859b2STodor Tomov clock->freq[j] = res->clock_rate[i][j];
6594863b93cSAngeloGioacchino Del Regno
6600727615fSBryan O'Donoghue for (k = 0; k < camss->res->csiphy_num; k++) {
6610727615fSBryan O'Donoghue csiphy->rate_set[i] = csiphy_match_clock_name(clock->name,
6620727615fSBryan O'Donoghue "csiphy%d_timer", k);
6630727615fSBryan O'Donoghue if (csiphy->rate_set[i])
6640727615fSBryan O'Donoghue break;
6654863b93cSAngeloGioacchino Del Regno
6660727615fSBryan O'Donoghue if (camss->res->version == CAMSS_660) {
6670727615fSBryan O'Donoghue csiphy->rate_set[i] = csiphy_match_clock_name(clock->name,
6680727615fSBryan O'Donoghue "csi%d_phy", k);
6690727615fSBryan O'Donoghue if (csiphy->rate_set[i])
6700727615fSBryan O'Donoghue break;
6710727615fSBryan O'Donoghue }
67235a62432SBryan O'Donoghue
67335a62432SBryan O'Donoghue csiphy->rate_set[i] = csiphy_match_clock_name(clock->name, "csiphy%d", k);
67435a62432SBryan O'Donoghue if (csiphy->rate_set[i])
67535a62432SBryan O'Donoghue break;
6760727615fSBryan O'Donoghue }
677ec6859b2STodor Tomov }
678ec6859b2STodor Tomov
679ec6859b2STodor Tomov return 0;
680ec6859b2STodor Tomov }
681ec6859b2STodor Tomov
682ec6859b2STodor Tomov /*
683ec6859b2STodor Tomov * csiphy_link_setup - Setup CSIPHY connections
684ec6859b2STodor Tomov * @entity: Pointer to media entity structure
685ec6859b2STodor Tomov * @local: Pointer to local pad
686ec6859b2STodor Tomov * @remote: Pointer to remote pad
687ec6859b2STodor Tomov * @flags: Link flags
688ec6859b2STodor Tomov *
689ec6859b2STodor Tomov * Rreturn 0 on success
690ec6859b2STodor Tomov */
csiphy_link_setup(struct media_entity * entity,const struct media_pad * local,const struct media_pad * remote,u32 flags)691ec6859b2STodor Tomov static int csiphy_link_setup(struct media_entity *entity,
692ec6859b2STodor Tomov const struct media_pad *local,
693ec6859b2STodor Tomov const struct media_pad *remote, u32 flags)
694ec6859b2STodor Tomov {
695ec6859b2STodor Tomov if ((local->flags & MEDIA_PAD_FL_SOURCE) &&
696ec6859b2STodor Tomov (flags & MEDIA_LNK_FL_ENABLED)) {
697ec6859b2STodor Tomov struct v4l2_subdev *sd;
698ec6859b2STodor Tomov struct csiphy_device *csiphy;
699ec6859b2STodor Tomov struct csid_device *csid;
700ec6859b2STodor Tomov
701b2e44430SLaurent Pinchart if (media_pad_remote_pad_first(local))
702ec6859b2STodor Tomov return -EBUSY;
703ec6859b2STodor Tomov
704ec6859b2STodor Tomov sd = media_entity_to_v4l2_subdev(entity);
705ec6859b2STodor Tomov csiphy = v4l2_get_subdevdata(sd);
706ec6859b2STodor Tomov
707ec6859b2STodor Tomov sd = media_entity_to_v4l2_subdev(remote->entity);
708ec6859b2STodor Tomov csid = v4l2_get_subdevdata(sd);
709ec6859b2STodor Tomov
710ec6859b2STodor Tomov csiphy->cfg.csid_id = csid->id;
711ec6859b2STodor Tomov }
712ec6859b2STodor Tomov
713ec6859b2STodor Tomov return 0;
714ec6859b2STodor Tomov }
715ec6859b2STodor Tomov
716ec6859b2STodor Tomov static const struct v4l2_subdev_core_ops csiphy_core_ops = {
717ec6859b2STodor Tomov .s_power = csiphy_set_power,
718ec6859b2STodor Tomov };
719ec6859b2STodor Tomov
720ec6859b2STodor Tomov static const struct v4l2_subdev_video_ops csiphy_video_ops = {
721ec6859b2STodor Tomov .s_stream = csiphy_set_stream,
722ec6859b2STodor Tomov };
723ec6859b2STodor Tomov
724ec6859b2STodor Tomov static const struct v4l2_subdev_pad_ops csiphy_pad_ops = {
725ec6859b2STodor Tomov .enum_mbus_code = csiphy_enum_mbus_code,
726ec6859b2STodor Tomov .enum_frame_size = csiphy_enum_frame_size,
727ec6859b2STodor Tomov .get_fmt = csiphy_get_format,
728ec6859b2STodor Tomov .set_fmt = csiphy_set_format,
729ec6859b2STodor Tomov };
730ec6859b2STodor Tomov
731ec6859b2STodor Tomov static const struct v4l2_subdev_ops csiphy_v4l2_ops = {
732ec6859b2STodor Tomov .core = &csiphy_core_ops,
733ec6859b2STodor Tomov .video = &csiphy_video_ops,
734ec6859b2STodor Tomov .pad = &csiphy_pad_ops,
735ec6859b2STodor Tomov };
736ec6859b2STodor Tomov
737ec6859b2STodor Tomov static const struct v4l2_subdev_internal_ops csiphy_v4l2_internal_ops = {
738ec6859b2STodor Tomov .open = csiphy_init_formats,
739ec6859b2STodor Tomov };
740ec6859b2STodor Tomov
741ec6859b2STodor Tomov static const struct media_entity_operations csiphy_media_ops = {
742ec6859b2STodor Tomov .link_setup = csiphy_link_setup,
743ec6859b2STodor Tomov .link_validate = v4l2_subdev_link_validate,
744ec6859b2STodor Tomov };
745ec6859b2STodor Tomov
746ec6859b2STodor Tomov /*
747ec6859b2STodor Tomov * msm_csiphy_register_entity - Register subdev node for CSIPHY module
748ec6859b2STodor Tomov * @csiphy: CSIPHY device
749ec6859b2STodor Tomov * @v4l2_dev: V4L2 device
750ec6859b2STodor Tomov *
751ec6859b2STodor Tomov * Return 0 on success or a negative error code otherwise
752ec6859b2STodor Tomov */
msm_csiphy_register_entity(struct csiphy_device * csiphy,struct v4l2_device * v4l2_dev)753ec6859b2STodor Tomov int msm_csiphy_register_entity(struct csiphy_device *csiphy,
754ec6859b2STodor Tomov struct v4l2_device *v4l2_dev)
755ec6859b2STodor Tomov {
756ec6859b2STodor Tomov struct v4l2_subdev *sd = &csiphy->subdev;
757ec6859b2STodor Tomov struct media_pad *pads = csiphy->pads;
7589c3e59deSTodor Tomov struct device *dev = csiphy->camss->dev;
759ec6859b2STodor Tomov int ret;
760ec6859b2STodor Tomov
761ec6859b2STodor Tomov v4l2_subdev_init(sd, &csiphy_v4l2_ops);
762ec6859b2STodor Tomov sd->internal_ops = &csiphy_v4l2_internal_ops;
763ec6859b2STodor Tomov sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
764ec6859b2STodor Tomov snprintf(sd->name, ARRAY_SIZE(sd->name), "%s%d",
765ec6859b2STodor Tomov MSM_CSIPHY_NAME, csiphy->id);
766ec6859b2STodor Tomov v4l2_set_subdevdata(sd, csiphy);
767ec6859b2STodor Tomov
768ec6859b2STodor Tomov ret = csiphy_init_formats(sd, NULL);
769ec6859b2STodor Tomov if (ret < 0) {
770ec6859b2STodor Tomov dev_err(dev, "Failed to init format: %d\n", ret);
771ec6859b2STodor Tomov return ret;
772ec6859b2STodor Tomov }
773ec6859b2STodor Tomov
774ec6859b2STodor Tomov pads[MSM_CSIPHY_PAD_SINK].flags = MEDIA_PAD_FL_SINK;
775ec6859b2STodor Tomov pads[MSM_CSIPHY_PAD_SRC].flags = MEDIA_PAD_FL_SOURCE;
776ec6859b2STodor Tomov
77750795910SAndrey Konovalov sd->entity.function = MEDIA_ENT_F_PROC_VIDEO_PIXEL_FORMATTER;
778ec6859b2STodor Tomov sd->entity.ops = &csiphy_media_ops;
779ec6859b2STodor Tomov ret = media_entity_pads_init(&sd->entity, MSM_CSIPHY_PADS_NUM, pads);
780ec6859b2STodor Tomov if (ret < 0) {
781ec6859b2STodor Tomov dev_err(dev, "Failed to init media entity: %d\n", ret);
782ec6859b2STodor Tomov return ret;
783ec6859b2STodor Tomov }
784ec6859b2STodor Tomov
785ec6859b2STodor Tomov ret = v4l2_device_register_subdev(v4l2_dev, sd);
786ec6859b2STodor Tomov if (ret < 0) {
787ec6859b2STodor Tomov dev_err(dev, "Failed to register subdev: %d\n", ret);
788ec6859b2STodor Tomov media_entity_cleanup(&sd->entity);
789ec6859b2STodor Tomov }
790ec6859b2STodor Tomov
791ec6859b2STodor Tomov return ret;
792ec6859b2STodor Tomov }
793ec6859b2STodor Tomov
794ec6859b2STodor Tomov /*
795ec6859b2STodor Tomov * msm_csiphy_unregister_entity - Unregister CSIPHY module subdev node
796ec6859b2STodor Tomov * @csiphy: CSIPHY device
797ec6859b2STodor Tomov */
msm_csiphy_unregister_entity(struct csiphy_device * csiphy)798ec6859b2STodor Tomov void msm_csiphy_unregister_entity(struct csiphy_device *csiphy)
799ec6859b2STodor Tomov {
800ec6859b2STodor Tomov v4l2_device_unregister_subdev(&csiphy->subdev);
801ec6859b2STodor Tomov media_entity_cleanup(&csiphy->subdev.entity);
802ec6859b2STodor Tomov }
803