media-dev.c 37 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498
  1. /*
  2. * S5P/EXYNOS4 SoC series camera host interface media device driver
  3. *
  4. * Copyright (C) 2011 - 2013 Samsung Electronics Co., Ltd.
  5. * Author: Sylwester Nawrocki <s.nawrocki@samsung.com>
  6. *
  7. * This program is free software; you can redistribute it and/or modify
  8. * it under the terms of the GNU General Public License as published
  9. * by the Free Software Foundation, either version 2 of the License,
  10. * or (at your option) any later version.
  11. */
  12. #include <linux/bug.h>
  13. #include <linux/clk.h>
  14. #include <linux/clk-provider.h>
  15. #include <linux/device.h>
  16. #include <linux/errno.h>
  17. #include <linux/i2c.h>
  18. #include <linux/kernel.h>
  19. #include <linux/list.h>
  20. #include <linux/module.h>
  21. #include <linux/of.h>
  22. #include <linux/of_platform.h>
  23. #include <linux/of_device.h>
  24. #include <linux/of_graph.h>
  25. #include <linux/platform_device.h>
  26. #include <linux/pm_runtime.h>
  27. #include <linux/types.h>
  28. #include <linux/slab.h>
  29. #include <media/v4l2-async.h>
  30. #include <media/v4l2-ctrls.h>
  31. #include <media/v4l2-of.h>
  32. #include <media/media-device.h>
  33. #include <media/exynos-fimc.h>
  34. #include "media-dev.h"
  35. #include "fimc-core.h"
  36. #include "fimc-is.h"
  37. #include "fimc-lite.h"
  38. #include "mipi-csis.h"
  39. /* Set up image sensor subdev -> FIMC capture node notifications. */
  40. static void __setup_sensor_notification(struct fimc_md *fmd,
  41. struct v4l2_subdev *sensor,
  42. struct v4l2_subdev *fimc_sd)
  43. {
  44. struct fimc_source_info *src_inf;
  45. struct fimc_sensor_info *md_si;
  46. unsigned long flags;
  47. src_inf = v4l2_get_subdev_hostdata(sensor);
  48. if (!src_inf || WARN_ON(fmd == NULL))
  49. return;
  50. md_si = source_to_sensor_info(src_inf);
  51. spin_lock_irqsave(&fmd->slock, flags);
  52. md_si->host = v4l2_get_subdevdata(fimc_sd);
  53. spin_unlock_irqrestore(&fmd->slock, flags);
  54. }
  55. /**
  56. * fimc_pipeline_prepare - update pipeline information with subdevice pointers
  57. * @me: media entity terminating the pipeline
  58. *
  59. * Caller holds the graph mutex.
  60. */
  61. static void fimc_pipeline_prepare(struct fimc_pipeline *p,
  62. struct media_entity *me)
  63. {
  64. struct fimc_md *fmd = entity_to_fimc_mdev(me);
  65. struct v4l2_subdev *sd;
  66. struct v4l2_subdev *sensor = NULL;
  67. int i;
  68. for (i = 0; i < IDX_MAX; i++)
  69. p->subdevs[i] = NULL;
  70. while (1) {
  71. struct media_pad *pad = NULL;
  72. /* Find remote source pad */
  73. for (i = 0; i < me->num_pads; i++) {
  74. struct media_pad *spad = &me->pads[i];
  75. if (!(spad->flags & MEDIA_PAD_FL_SINK))
  76. continue;
  77. pad = media_entity_remote_pad(spad);
  78. if (pad)
  79. break;
  80. }
  81. if (pad == NULL ||
  82. media_entity_type(pad->entity) != MEDIA_ENT_T_V4L2_SUBDEV)
  83. break;
  84. sd = media_entity_to_v4l2_subdev(pad->entity);
  85. switch (sd->grp_id) {
  86. case GRP_ID_SENSOR:
  87. sensor = sd;
  88. /* fall through */
  89. case GRP_ID_FIMC_IS_SENSOR:
  90. p->subdevs[IDX_SENSOR] = sd;
  91. break;
  92. case GRP_ID_CSIS:
  93. p->subdevs[IDX_CSIS] = sd;
  94. break;
  95. case GRP_ID_FLITE:
  96. p->subdevs[IDX_FLITE] = sd;
  97. break;
  98. case GRP_ID_FIMC:
  99. p->subdevs[IDX_FIMC] = sd;
  100. break;
  101. case GRP_ID_FIMC_IS:
  102. p->subdevs[IDX_IS_ISP] = sd;
  103. break;
  104. default:
  105. break;
  106. }
  107. me = &sd->entity;
  108. if (me->num_pads == 1)
  109. break;
  110. }
  111. if (sensor && p->subdevs[IDX_FIMC])
  112. __setup_sensor_notification(fmd, sensor, p->subdevs[IDX_FIMC]);
  113. }
  114. /**
  115. * __subdev_set_power - change power state of a single subdev
  116. * @sd: subdevice to change power state for
  117. * @on: 1 to enable power or 0 to disable
  118. *
  119. * Return result of s_power subdev operation or -ENXIO if sd argument
  120. * is NULL. Return 0 if the subdevice does not implement s_power.
  121. */
  122. static int __subdev_set_power(struct v4l2_subdev *sd, int on)
  123. {
  124. int *use_count;
  125. int ret;
  126. if (sd == NULL)
  127. return -ENXIO;
  128. use_count = &sd->entity.use_count;
  129. if (on && (*use_count)++ > 0)
  130. return 0;
  131. else if (!on && (*use_count == 0 || --(*use_count) > 0))
  132. return 0;
  133. ret = v4l2_subdev_call(sd, core, s_power, on);
  134. return ret != -ENOIOCTLCMD ? ret : 0;
  135. }
  136. /**
  137. * fimc_pipeline_s_power - change power state of all pipeline subdevs
  138. * @fimc: fimc device terminating the pipeline
  139. * @state: true to power on, false to power off
  140. *
  141. * Needs to be called with the graph mutex held.
  142. */
  143. static int fimc_pipeline_s_power(struct fimc_pipeline *p, bool on)
  144. {
  145. static const u8 seq[2][IDX_MAX - 1] = {
  146. { IDX_IS_ISP, IDX_SENSOR, IDX_CSIS, IDX_FLITE },
  147. { IDX_CSIS, IDX_FLITE, IDX_SENSOR, IDX_IS_ISP },
  148. };
  149. int i, ret = 0;
  150. if (p->subdevs[IDX_SENSOR] == NULL)
  151. return -ENXIO;
  152. for (i = 0; i < IDX_MAX - 1; i++) {
  153. unsigned int idx = seq[on][i];
  154. ret = __subdev_set_power(p->subdevs[idx], on);
  155. if (ret < 0 && ret != -ENXIO)
  156. goto error;
  157. }
  158. return 0;
  159. error:
  160. for (; i >= 0; i--) {
  161. unsigned int idx = seq[on][i];
  162. __subdev_set_power(p->subdevs[idx], !on);
  163. }
  164. return ret;
  165. }
  166. /**
  167. * __fimc_pipeline_open - update the pipeline information, enable power
  168. * of all pipeline subdevs and the sensor clock
  169. * @me: media entity to start graph walk with
  170. * @prepare: true to walk the current pipeline and acquire all subdevs
  171. *
  172. * Called with the graph mutex held.
  173. */
  174. static int __fimc_pipeline_open(struct exynos_media_pipeline *ep,
  175. struct media_entity *me, bool prepare)
  176. {
  177. struct fimc_md *fmd = entity_to_fimc_mdev(me);
  178. struct fimc_pipeline *p = to_fimc_pipeline(ep);
  179. struct v4l2_subdev *sd;
  180. int ret;
  181. if (WARN_ON(p == NULL || me == NULL))
  182. return -EINVAL;
  183. if (prepare)
  184. fimc_pipeline_prepare(p, me);
  185. sd = p->subdevs[IDX_SENSOR];
  186. if (sd == NULL)
  187. return -EINVAL;
  188. /* Disable PXLASYNC clock if this pipeline includes FIMC-IS */
  189. if (!IS_ERR(fmd->wbclk[CLK_IDX_WB_B]) && p->subdevs[IDX_IS_ISP]) {
  190. ret = clk_prepare_enable(fmd->wbclk[CLK_IDX_WB_B]);
  191. if (ret < 0)
  192. return ret;
  193. }
  194. ret = fimc_pipeline_s_power(p, 1);
  195. if (!ret)
  196. return 0;
  197. if (!IS_ERR(fmd->wbclk[CLK_IDX_WB_B]) && p->subdevs[IDX_IS_ISP])
  198. clk_disable_unprepare(fmd->wbclk[CLK_IDX_WB_B]);
  199. return ret;
  200. }
  201. /**
  202. * __fimc_pipeline_close - disable the sensor clock and pipeline power
  203. * @fimc: fimc device terminating the pipeline
  204. *
  205. * Disable power of all subdevs and turn the external sensor clock off.
  206. */
  207. static int __fimc_pipeline_close(struct exynos_media_pipeline *ep)
  208. {
  209. struct fimc_pipeline *p = to_fimc_pipeline(ep);
  210. struct v4l2_subdev *sd = p ? p->subdevs[IDX_SENSOR] : NULL;
  211. struct fimc_md *fmd;
  212. int ret;
  213. if (sd == NULL) {
  214. pr_warn("%s(): No sensor subdev\n", __func__);
  215. return 0;
  216. }
  217. ret = fimc_pipeline_s_power(p, 0);
  218. fmd = entity_to_fimc_mdev(&sd->entity);
  219. /* Disable PXLASYNC clock if this pipeline includes FIMC-IS */
  220. if (!IS_ERR(fmd->wbclk[CLK_IDX_WB_B]) && p->subdevs[IDX_IS_ISP])
  221. clk_disable_unprepare(fmd->wbclk[CLK_IDX_WB_B]);
  222. return ret == -ENXIO ? 0 : ret;
  223. }
  224. /**
  225. * __fimc_pipeline_s_stream - call s_stream() on pipeline subdevs
  226. * @pipeline: video pipeline structure
  227. * @on: passed as the s_stream() callback argument
  228. */
  229. static int __fimc_pipeline_s_stream(struct exynos_media_pipeline *ep, bool on)
  230. {
  231. static const u8 seq[2][IDX_MAX] = {
  232. { IDX_FIMC, IDX_SENSOR, IDX_IS_ISP, IDX_CSIS, IDX_FLITE },
  233. { IDX_CSIS, IDX_FLITE, IDX_FIMC, IDX_SENSOR, IDX_IS_ISP },
  234. };
  235. struct fimc_pipeline *p = to_fimc_pipeline(ep);
  236. int i, ret = 0;
  237. if (p->subdevs[IDX_SENSOR] == NULL)
  238. return -ENODEV;
  239. for (i = 0; i < IDX_MAX; i++) {
  240. unsigned int idx = seq[on][i];
  241. ret = v4l2_subdev_call(p->subdevs[idx], video, s_stream, on);
  242. if (ret < 0 && ret != -ENOIOCTLCMD && ret != -ENODEV)
  243. goto error;
  244. }
  245. return 0;
  246. error:
  247. for (; i >= 0; i--) {
  248. unsigned int idx = seq[on][i];
  249. v4l2_subdev_call(p->subdevs[idx], video, s_stream, !on);
  250. }
  251. return ret;
  252. }
  253. /* Media pipeline operations for the FIMC/FIMC-LITE video device driver */
  254. static const struct exynos_media_pipeline_ops fimc_pipeline_ops = {
  255. .open = __fimc_pipeline_open,
  256. .close = __fimc_pipeline_close,
  257. .set_stream = __fimc_pipeline_s_stream,
  258. };
  259. static struct exynos_media_pipeline *fimc_md_pipeline_create(
  260. struct fimc_md *fmd)
  261. {
  262. struct fimc_pipeline *p;
  263. p = kzalloc(sizeof(*p), GFP_KERNEL);
  264. if (!p)
  265. return NULL;
  266. list_add_tail(&p->list, &fmd->pipelines);
  267. p->ep.ops = &fimc_pipeline_ops;
  268. return &p->ep;
  269. }
  270. static void fimc_md_pipelines_free(struct fimc_md *fmd)
  271. {
  272. while (!list_empty(&fmd->pipelines)) {
  273. struct fimc_pipeline *p;
  274. p = list_entry(fmd->pipelines.next, typeof(*p), list);
  275. list_del(&p->list);
  276. kfree(p);
  277. }
  278. }
  279. /* Parse port node and register as a sub-device any sensor specified there. */
  280. static int fimc_md_parse_port_node(struct fimc_md *fmd,
  281. struct device_node *port,
  282. unsigned int index)
  283. {
  284. struct fimc_source_info *pd = &fmd->sensor[index].pdata;
  285. struct device_node *rem, *ep, *np;
  286. struct v4l2_of_endpoint endpoint;
  287. /* Assume here a port node can have only one endpoint node. */
  288. ep = of_get_next_child(port, NULL);
  289. if (!ep)
  290. return 0;
  291. v4l2_of_parse_endpoint(ep, &endpoint);
  292. if (WARN_ON(endpoint.base.port == 0) || index >= FIMC_MAX_SENSORS)
  293. return -EINVAL;
  294. pd->mux_id = (endpoint.base.port - 1) & 0x1;
  295. rem = of_graph_get_remote_port_parent(ep);
  296. of_node_put(ep);
  297. if (rem == NULL) {
  298. v4l2_info(&fmd->v4l2_dev, "Remote device at %s not found\n",
  299. ep->full_name);
  300. return 0;
  301. }
  302. if (fimc_input_is_parallel(endpoint.base.port)) {
  303. if (endpoint.bus_type == V4L2_MBUS_PARALLEL)
  304. pd->sensor_bus_type = FIMC_BUS_TYPE_ITU_601;
  305. else
  306. pd->sensor_bus_type = FIMC_BUS_TYPE_ITU_656;
  307. pd->flags = endpoint.bus.parallel.flags;
  308. } else if (fimc_input_is_mipi_csi(endpoint.base.port)) {
  309. /*
  310. * MIPI CSI-2: only input mux selection and
  311. * the sensor's clock frequency is needed.
  312. */
  313. pd->sensor_bus_type = FIMC_BUS_TYPE_MIPI_CSI2;
  314. } else {
  315. v4l2_err(&fmd->v4l2_dev, "Wrong port id (%u) at node %s\n",
  316. endpoint.base.port, rem->full_name);
  317. }
  318. /*
  319. * For FIMC-IS handled sensors, that are placed under i2c-isp device
  320. * node, FIMC is connected to the FIMC-IS through its ISP Writeback
  321. * input. Sensors are attached to the FIMC-LITE hostdata interface
  322. * directly or through MIPI-CSIS, depending on the external media bus
  323. * used. This needs to be handled in a more reliable way, not by just
  324. * checking parent's node name.
  325. */
  326. np = of_get_parent(rem);
  327. if (np && !of_node_cmp(np->name, "i2c-isp"))
  328. pd->fimc_bus_type = FIMC_BUS_TYPE_ISP_WRITEBACK;
  329. else
  330. pd->fimc_bus_type = pd->sensor_bus_type;
  331. if (WARN_ON(index >= ARRAY_SIZE(fmd->sensor)))
  332. return -EINVAL;
  333. fmd->sensor[index].asd.match_type = V4L2_ASYNC_MATCH_OF;
  334. fmd->sensor[index].asd.match.of.node = rem;
  335. fmd->async_subdevs[index] = &fmd->sensor[index].asd;
  336. fmd->num_sensors++;
  337. of_node_put(rem);
  338. return 0;
  339. }
  340. /* Register all SoC external sub-devices */
  341. static int fimc_md_register_sensor_entities(struct fimc_md *fmd)
  342. {
  343. struct device_node *parent = fmd->pdev->dev.of_node;
  344. struct device_node *node, *ports;
  345. int index = 0;
  346. int ret;
  347. /*
  348. * Runtime resume one of the FIMC entities to make sure
  349. * the sclk_cam clocks are not globally disabled.
  350. */
  351. if (!fmd->pmf)
  352. return -ENXIO;
  353. ret = pm_runtime_get_sync(fmd->pmf);
  354. if (ret < 0)
  355. return ret;
  356. fmd->num_sensors = 0;
  357. /* Attach sensors linked to MIPI CSI-2 receivers */
  358. for_each_available_child_of_node(parent, node) {
  359. struct device_node *port;
  360. if (of_node_cmp(node->name, "csis"))
  361. continue;
  362. /* The csis node can have only port subnode. */
  363. port = of_get_next_child(node, NULL);
  364. if (!port)
  365. continue;
  366. ret = fimc_md_parse_port_node(fmd, port, index);
  367. if (ret < 0)
  368. goto rpm_put;
  369. index++;
  370. }
  371. /* Attach sensors listed in the parallel-ports node */
  372. ports = of_get_child_by_name(parent, "parallel-ports");
  373. if (!ports)
  374. goto rpm_put;
  375. for_each_child_of_node(ports, node) {
  376. ret = fimc_md_parse_port_node(fmd, node, index);
  377. if (ret < 0)
  378. break;
  379. index++;
  380. }
  381. rpm_put:
  382. pm_runtime_put(fmd->pmf);
  383. return ret;
  384. }
  385. static int __of_get_csis_id(struct device_node *np)
  386. {
  387. u32 reg = 0;
  388. np = of_get_child_by_name(np, "port");
  389. if (!np)
  390. return -EINVAL;
  391. of_property_read_u32(np, "reg", &reg);
  392. return reg - FIMC_INPUT_MIPI_CSI2_0;
  393. }
  394. /*
  395. * MIPI-CSIS, FIMC and FIMC-LITE platform devices registration.
  396. */
  397. static int register_fimc_lite_entity(struct fimc_md *fmd,
  398. struct fimc_lite *fimc_lite)
  399. {
  400. struct v4l2_subdev *sd;
  401. struct exynos_media_pipeline *ep;
  402. int ret;
  403. if (WARN_ON(fimc_lite->index >= FIMC_LITE_MAX_DEVS ||
  404. fmd->fimc_lite[fimc_lite->index]))
  405. return -EBUSY;
  406. sd = &fimc_lite->subdev;
  407. sd->grp_id = GRP_ID_FLITE;
  408. ep = fimc_md_pipeline_create(fmd);
  409. if (!ep)
  410. return -ENOMEM;
  411. v4l2_set_subdev_hostdata(sd, ep);
  412. ret = v4l2_device_register_subdev(&fmd->v4l2_dev, sd);
  413. if (!ret)
  414. fmd->fimc_lite[fimc_lite->index] = fimc_lite;
  415. else
  416. v4l2_err(&fmd->v4l2_dev, "Failed to register FIMC.LITE%d\n",
  417. fimc_lite->index);
  418. return ret;
  419. }
  420. static int register_fimc_entity(struct fimc_md *fmd, struct fimc_dev *fimc)
  421. {
  422. struct v4l2_subdev *sd;
  423. struct exynos_media_pipeline *ep;
  424. int ret;
  425. if (WARN_ON(fimc->id >= FIMC_MAX_DEVS || fmd->fimc[fimc->id]))
  426. return -EBUSY;
  427. sd = &fimc->vid_cap.subdev;
  428. sd->grp_id = GRP_ID_FIMC;
  429. ep = fimc_md_pipeline_create(fmd);
  430. if (!ep)
  431. return -ENOMEM;
  432. v4l2_set_subdev_hostdata(sd, ep);
  433. ret = v4l2_device_register_subdev(&fmd->v4l2_dev, sd);
  434. if (!ret) {
  435. if (!fmd->pmf && fimc->pdev)
  436. fmd->pmf = &fimc->pdev->dev;
  437. fmd->fimc[fimc->id] = fimc;
  438. fimc->vid_cap.user_subdev_api = fmd->user_subdev_api;
  439. } else {
  440. v4l2_err(&fmd->v4l2_dev, "Failed to register FIMC.%d (%d)\n",
  441. fimc->id, ret);
  442. }
  443. return ret;
  444. }
  445. static int register_csis_entity(struct fimc_md *fmd,
  446. struct platform_device *pdev,
  447. struct v4l2_subdev *sd)
  448. {
  449. struct device_node *node = pdev->dev.of_node;
  450. int id, ret;
  451. id = node ? __of_get_csis_id(node) : max(0, pdev->id);
  452. if (WARN_ON(id < 0 || id >= CSIS_MAX_ENTITIES))
  453. return -ENOENT;
  454. if (WARN_ON(fmd->csis[id].sd))
  455. return -EBUSY;
  456. sd->grp_id = GRP_ID_CSIS;
  457. ret = v4l2_device_register_subdev(&fmd->v4l2_dev, sd);
  458. if (!ret)
  459. fmd->csis[id].sd = sd;
  460. else
  461. v4l2_err(&fmd->v4l2_dev,
  462. "Failed to register MIPI-CSIS.%d (%d)\n", id, ret);
  463. return ret;
  464. }
  465. static int register_fimc_is_entity(struct fimc_md *fmd, struct fimc_is *is)
  466. {
  467. struct v4l2_subdev *sd = &is->isp.subdev;
  468. struct exynos_media_pipeline *ep;
  469. int ret;
  470. /* Allocate pipeline object for the ISP capture video node. */
  471. ep = fimc_md_pipeline_create(fmd);
  472. if (!ep)
  473. return -ENOMEM;
  474. v4l2_set_subdev_hostdata(sd, ep);
  475. ret = v4l2_device_register_subdev(&fmd->v4l2_dev, sd);
  476. if (ret) {
  477. v4l2_err(&fmd->v4l2_dev,
  478. "Failed to register FIMC-ISP (%d)\n", ret);
  479. return ret;
  480. }
  481. fmd->fimc_is = is;
  482. return 0;
  483. }
  484. static int fimc_md_register_platform_entity(struct fimc_md *fmd,
  485. struct platform_device *pdev,
  486. int plat_entity)
  487. {
  488. struct device *dev = &pdev->dev;
  489. int ret = -EPROBE_DEFER;
  490. void *drvdata;
  491. /* Lock to ensure dev->driver won't change. */
  492. device_lock(dev);
  493. if (!dev->driver || !try_module_get(dev->driver->owner))
  494. goto dev_unlock;
  495. drvdata = dev_get_drvdata(dev);
  496. /* Some subdev didn't probe successfully id drvdata is NULL */
  497. if (drvdata) {
  498. switch (plat_entity) {
  499. case IDX_FIMC:
  500. ret = register_fimc_entity(fmd, drvdata);
  501. break;
  502. case IDX_FLITE:
  503. ret = register_fimc_lite_entity(fmd, drvdata);
  504. break;
  505. case IDX_CSIS:
  506. ret = register_csis_entity(fmd, pdev, drvdata);
  507. break;
  508. case IDX_IS_ISP:
  509. ret = register_fimc_is_entity(fmd, drvdata);
  510. break;
  511. default:
  512. ret = -ENODEV;
  513. }
  514. }
  515. module_put(dev->driver->owner);
  516. dev_unlock:
  517. device_unlock(dev);
  518. if (ret == -EPROBE_DEFER)
  519. dev_info(&fmd->pdev->dev, "deferring %s device registration\n",
  520. dev_name(dev));
  521. else if (ret < 0)
  522. dev_err(&fmd->pdev->dev, "%s device registration failed (%d)\n",
  523. dev_name(dev), ret);
  524. return ret;
  525. }
  526. /* Register FIMC, FIMC-LITE and CSIS media entities */
  527. static int fimc_md_register_platform_entities(struct fimc_md *fmd,
  528. struct device_node *parent)
  529. {
  530. struct device_node *node;
  531. int ret = 0;
  532. for_each_available_child_of_node(parent, node) {
  533. struct platform_device *pdev;
  534. int plat_entity = -1;
  535. pdev = of_find_device_by_node(node);
  536. if (!pdev)
  537. continue;
  538. /* If driver of any entity isn't ready try all again later. */
  539. if (!strcmp(node->name, CSIS_OF_NODE_NAME))
  540. plat_entity = IDX_CSIS;
  541. else if (!strcmp(node->name, FIMC_IS_OF_NODE_NAME))
  542. plat_entity = IDX_IS_ISP;
  543. else if (!strcmp(node->name, FIMC_LITE_OF_NODE_NAME))
  544. plat_entity = IDX_FLITE;
  545. else if (!strcmp(node->name, FIMC_OF_NODE_NAME) &&
  546. !of_property_read_bool(node, "samsung,lcd-wb"))
  547. plat_entity = IDX_FIMC;
  548. if (plat_entity >= 0)
  549. ret = fimc_md_register_platform_entity(fmd, pdev,
  550. plat_entity);
  551. put_device(&pdev->dev);
  552. if (ret < 0)
  553. break;
  554. }
  555. return ret;
  556. }
  557. static void fimc_md_unregister_entities(struct fimc_md *fmd)
  558. {
  559. int i;
  560. for (i = 0; i < FIMC_MAX_DEVS; i++) {
  561. struct fimc_dev *dev = fmd->fimc[i];
  562. if (dev == NULL)
  563. continue;
  564. v4l2_device_unregister_subdev(&dev->vid_cap.subdev);
  565. dev->vid_cap.ve.pipe = NULL;
  566. fmd->fimc[i] = NULL;
  567. }
  568. for (i = 0; i < FIMC_LITE_MAX_DEVS; i++) {
  569. struct fimc_lite *dev = fmd->fimc_lite[i];
  570. if (dev == NULL)
  571. continue;
  572. v4l2_device_unregister_subdev(&dev->subdev);
  573. dev->ve.pipe = NULL;
  574. fmd->fimc_lite[i] = NULL;
  575. }
  576. for (i = 0; i < CSIS_MAX_ENTITIES; i++) {
  577. if (fmd->csis[i].sd == NULL)
  578. continue;
  579. v4l2_device_unregister_subdev(fmd->csis[i].sd);
  580. fmd->csis[i].sd = NULL;
  581. }
  582. if (fmd->fimc_is)
  583. v4l2_device_unregister_subdev(&fmd->fimc_is->isp.subdev);
  584. v4l2_info(&fmd->v4l2_dev, "Unregistered all entities\n");
  585. }
  586. /**
  587. * __fimc_md_create_fimc_links - create links to all FIMC entities
  588. * @fmd: fimc media device
  589. * @source: the source entity to create links to all fimc entities from
  590. * @sensor: sensor subdev linked to FIMC[fimc_id] entity, may be null
  591. * @pad: the source entity pad index
  592. * @link_mask: bitmask of the fimc devices for which link should be enabled
  593. */
  594. static int __fimc_md_create_fimc_sink_links(struct fimc_md *fmd,
  595. struct media_entity *source,
  596. struct v4l2_subdev *sensor,
  597. int pad, int link_mask)
  598. {
  599. struct fimc_source_info *si = NULL;
  600. struct media_entity *sink;
  601. unsigned int flags = 0;
  602. int i, ret = 0;
  603. if (sensor) {
  604. si = v4l2_get_subdev_hostdata(sensor);
  605. /* Skip direct FIMC links in the logical FIMC-IS sensor path */
  606. if (si && si->fimc_bus_type == FIMC_BUS_TYPE_ISP_WRITEBACK)
  607. ret = 1;
  608. }
  609. for (i = 0; !ret && i < FIMC_MAX_DEVS; i++) {
  610. if (!fmd->fimc[i])
  611. continue;
  612. /*
  613. * Some FIMC variants are not fitted with camera capture
  614. * interface. Skip creating a link from sensor for those.
  615. */
  616. if (!fmd->fimc[i]->variant->has_cam_if)
  617. continue;
  618. flags = ((1 << i) & link_mask) ? MEDIA_LNK_FL_ENABLED : 0;
  619. sink = &fmd->fimc[i]->vid_cap.subdev.entity;
  620. ret = media_entity_create_link(source, pad, sink,
  621. FIMC_SD_PAD_SINK_CAM, flags);
  622. if (ret)
  623. return ret;
  624. /* Notify FIMC capture subdev entity */
  625. ret = media_entity_call(sink, link_setup, &sink->pads[0],
  626. &source->pads[pad], flags);
  627. if (ret)
  628. break;
  629. v4l2_info(&fmd->v4l2_dev, "created link [%s] %c> [%s]\n",
  630. source->name, flags ? '=' : '-', sink->name);
  631. }
  632. for (i = 0; i < FIMC_LITE_MAX_DEVS; i++) {
  633. if (!fmd->fimc_lite[i])
  634. continue;
  635. sink = &fmd->fimc_lite[i]->subdev.entity;
  636. ret = media_entity_create_link(source, pad, sink,
  637. FLITE_SD_PAD_SINK, 0);
  638. if (ret)
  639. return ret;
  640. /* Notify FIMC-LITE subdev entity */
  641. ret = media_entity_call(sink, link_setup, &sink->pads[0],
  642. &source->pads[pad], 0);
  643. if (ret)
  644. break;
  645. v4l2_info(&fmd->v4l2_dev, "created link [%s] -> [%s]\n",
  646. source->name, sink->name);
  647. }
  648. return 0;
  649. }
  650. /* Create links from FIMC-LITE source pads to other entities */
  651. static int __fimc_md_create_flite_source_links(struct fimc_md *fmd)
  652. {
  653. struct media_entity *source, *sink;
  654. int i, ret = 0;
  655. for (i = 0; i < FIMC_LITE_MAX_DEVS; i++) {
  656. struct fimc_lite *fimc = fmd->fimc_lite[i];
  657. if (fimc == NULL)
  658. continue;
  659. source = &fimc->subdev.entity;
  660. sink = &fimc->ve.vdev.entity;
  661. /* FIMC-LITE's subdev and video node */
  662. ret = media_entity_create_link(source, FLITE_SD_PAD_SOURCE_DMA,
  663. sink, 0, 0);
  664. if (ret)
  665. break;
  666. /* Link from FIMC-LITE to IS-ISP subdev */
  667. sink = &fmd->fimc_is->isp.subdev.entity;
  668. ret = media_entity_create_link(source, FLITE_SD_PAD_SOURCE_ISP,
  669. sink, 0, 0);
  670. if (ret)
  671. break;
  672. }
  673. return ret;
  674. }
  675. /* Create FIMC-IS links */
  676. static int __fimc_md_create_fimc_is_links(struct fimc_md *fmd)
  677. {
  678. struct fimc_isp *isp = &fmd->fimc_is->isp;
  679. struct media_entity *source, *sink;
  680. int i, ret;
  681. source = &isp->subdev.entity;
  682. for (i = 0; i < FIMC_MAX_DEVS; i++) {
  683. if (fmd->fimc[i] == NULL)
  684. continue;
  685. /* Link from FIMC-IS-ISP subdev to FIMC */
  686. sink = &fmd->fimc[i]->vid_cap.subdev.entity;
  687. ret = media_entity_create_link(source, FIMC_ISP_SD_PAD_SRC_FIFO,
  688. sink, FIMC_SD_PAD_SINK_FIFO, 0);
  689. if (ret)
  690. return ret;
  691. }
  692. /* Link from FIMC-IS-ISP subdev to fimc-is-isp.capture video node */
  693. sink = &isp->video_capture.ve.vdev.entity;
  694. /* Skip this link if the fimc-is-isp video node driver isn't built-in */
  695. if (sink->num_pads == 0)
  696. return 0;
  697. return media_entity_create_link(source, FIMC_ISP_SD_PAD_SRC_DMA,
  698. sink, 0, 0);
  699. }
  700. /**
  701. * fimc_md_create_links - create default links between registered entities
  702. *
  703. * Parallel interface sensor entities are connected directly to FIMC capture
  704. * entities. The sensors using MIPI CSIS bus are connected through immutable
  705. * link with CSI receiver entity specified by mux_id. Any registered CSIS
  706. * entity has a link to each registered FIMC capture entity. Enabled links
  707. * are created by default between each subsequent registered sensor and
  708. * subsequent FIMC capture entity. The number of default active links is
  709. * determined by the number of available sensors or FIMC entities,
  710. * whichever is less.
  711. */
  712. static int fimc_md_create_links(struct fimc_md *fmd)
  713. {
  714. struct v4l2_subdev *csi_sensors[CSIS_MAX_ENTITIES] = { NULL };
  715. struct v4l2_subdev *sensor, *csis;
  716. struct fimc_source_info *pdata;
  717. struct media_entity *source, *sink;
  718. int i, pad, fimc_id = 0, ret = 0;
  719. u32 flags, link_mask = 0;
  720. for (i = 0; i < fmd->num_sensors; i++) {
  721. if (fmd->sensor[i].subdev == NULL)
  722. continue;
  723. sensor = fmd->sensor[i].subdev;
  724. pdata = v4l2_get_subdev_hostdata(sensor);
  725. if (!pdata)
  726. continue;
  727. source = NULL;
  728. switch (pdata->sensor_bus_type) {
  729. case FIMC_BUS_TYPE_MIPI_CSI2:
  730. if (WARN(pdata->mux_id >= CSIS_MAX_ENTITIES,
  731. "Wrong CSI channel id: %d\n", pdata->mux_id))
  732. return -EINVAL;
  733. csis = fmd->csis[pdata->mux_id].sd;
  734. if (WARN(csis == NULL,
  735. "MIPI-CSI interface specified "
  736. "but s5p-csis module is not loaded!\n"))
  737. return -EINVAL;
  738. pad = sensor->entity.num_pads - 1;
  739. ret = media_entity_create_link(&sensor->entity, pad,
  740. &csis->entity, CSIS_PAD_SINK,
  741. MEDIA_LNK_FL_IMMUTABLE |
  742. MEDIA_LNK_FL_ENABLED);
  743. if (ret)
  744. return ret;
  745. v4l2_info(&fmd->v4l2_dev, "created link [%s] => [%s]\n",
  746. sensor->entity.name, csis->entity.name);
  747. source = NULL;
  748. csi_sensors[pdata->mux_id] = sensor;
  749. break;
  750. case FIMC_BUS_TYPE_ITU_601...FIMC_BUS_TYPE_ITU_656:
  751. source = &sensor->entity;
  752. pad = 0;
  753. break;
  754. default:
  755. v4l2_err(&fmd->v4l2_dev, "Wrong bus_type: %x\n",
  756. pdata->sensor_bus_type);
  757. return -EINVAL;
  758. }
  759. if (source == NULL)
  760. continue;
  761. link_mask = 1 << fimc_id++;
  762. ret = __fimc_md_create_fimc_sink_links(fmd, source, sensor,
  763. pad, link_mask);
  764. }
  765. for (i = 0; i < CSIS_MAX_ENTITIES; i++) {
  766. if (fmd->csis[i].sd == NULL)
  767. continue;
  768. source = &fmd->csis[i].sd->entity;
  769. pad = CSIS_PAD_SOURCE;
  770. sensor = csi_sensors[i];
  771. link_mask = 1 << fimc_id++;
  772. ret = __fimc_md_create_fimc_sink_links(fmd, source, sensor,
  773. pad, link_mask);
  774. }
  775. /* Create immutable links between each FIMC's subdev and video node */
  776. flags = MEDIA_LNK_FL_IMMUTABLE | MEDIA_LNK_FL_ENABLED;
  777. for (i = 0; i < FIMC_MAX_DEVS; i++) {
  778. if (!fmd->fimc[i])
  779. continue;
  780. source = &fmd->fimc[i]->vid_cap.subdev.entity;
  781. sink = &fmd->fimc[i]->vid_cap.ve.vdev.entity;
  782. ret = media_entity_create_link(source, FIMC_SD_PAD_SOURCE,
  783. sink, 0, flags);
  784. if (ret)
  785. break;
  786. }
  787. ret = __fimc_md_create_flite_source_links(fmd);
  788. if (ret < 0)
  789. return ret;
  790. if (fmd->use_isp)
  791. ret = __fimc_md_create_fimc_is_links(fmd);
  792. return ret;
  793. }
  794. /*
  795. * The peripheral sensor and CAM_BLK (PIXELASYNCMx) clocks management.
  796. */
  797. static void fimc_md_put_clocks(struct fimc_md *fmd)
  798. {
  799. int i = FIMC_MAX_CAMCLKS;
  800. while (--i >= 0) {
  801. if (IS_ERR(fmd->camclk[i].clock))
  802. continue;
  803. clk_put(fmd->camclk[i].clock);
  804. fmd->camclk[i].clock = ERR_PTR(-EINVAL);
  805. }
  806. /* Writeback (PIXELASYNCMx) clocks */
  807. for (i = 0; i < FIMC_MAX_WBCLKS; i++) {
  808. if (IS_ERR(fmd->wbclk[i]))
  809. continue;
  810. clk_put(fmd->wbclk[i]);
  811. fmd->wbclk[i] = ERR_PTR(-EINVAL);
  812. }
  813. }
  814. static int fimc_md_get_clocks(struct fimc_md *fmd)
  815. {
  816. struct device *dev = &fmd->pdev->dev;
  817. char clk_name[32];
  818. struct clk *clock;
  819. int i, ret = 0;
  820. for (i = 0; i < FIMC_MAX_CAMCLKS; i++)
  821. fmd->camclk[i].clock = ERR_PTR(-EINVAL);
  822. for (i = 0; i < FIMC_MAX_CAMCLKS; i++) {
  823. snprintf(clk_name, sizeof(clk_name), "sclk_cam%u", i);
  824. clock = clk_get(dev, clk_name);
  825. if (IS_ERR(clock)) {
  826. dev_err(dev, "Failed to get clock: %s\n", clk_name);
  827. ret = PTR_ERR(clock);
  828. break;
  829. }
  830. fmd->camclk[i].clock = clock;
  831. }
  832. if (ret)
  833. fimc_md_put_clocks(fmd);
  834. if (!fmd->use_isp)
  835. return 0;
  836. /*
  837. * For now get only PIXELASYNCM1 clock (Writeback B/ISP),
  838. * leave PIXELASYNCM0 out for the LCD Writeback driver.
  839. */
  840. fmd->wbclk[CLK_IDX_WB_A] = ERR_PTR(-EINVAL);
  841. for (i = CLK_IDX_WB_B; i < FIMC_MAX_WBCLKS; i++) {
  842. snprintf(clk_name, sizeof(clk_name), "pxl_async%u", i);
  843. clock = clk_get(dev, clk_name);
  844. if (IS_ERR(clock)) {
  845. v4l2_err(&fmd->v4l2_dev, "Failed to get clock: %s\n",
  846. clk_name);
  847. ret = PTR_ERR(clock);
  848. break;
  849. }
  850. fmd->wbclk[i] = clock;
  851. }
  852. if (ret)
  853. fimc_md_put_clocks(fmd);
  854. return ret;
  855. }
  856. static int __fimc_md_modify_pipeline(struct media_entity *entity, bool enable)
  857. {
  858. struct exynos_video_entity *ve;
  859. struct fimc_pipeline *p;
  860. struct video_device *vdev;
  861. int ret;
  862. vdev = media_entity_to_video_device(entity);
  863. if (vdev->entity.use_count == 0)
  864. return 0;
  865. ve = vdev_to_exynos_video_entity(vdev);
  866. p = to_fimc_pipeline(ve->pipe);
  867. /*
  868. * Nothing to do if we are disabling the pipeline, some link
  869. * has been disconnected and p->subdevs array is cleared now.
  870. */
  871. if (!enable && p->subdevs[IDX_SENSOR] == NULL)
  872. return 0;
  873. if (enable)
  874. ret = __fimc_pipeline_open(ve->pipe, entity, true);
  875. else
  876. ret = __fimc_pipeline_close(ve->pipe);
  877. if (ret == 0 && !enable)
  878. memset(p->subdevs, 0, sizeof(p->subdevs));
  879. return ret;
  880. }
  881. /* Locking: called with entity->parent->graph_mutex mutex held. */
  882. static int __fimc_md_modify_pipelines(struct media_entity *entity, bool enable)
  883. {
  884. struct media_entity *entity_err = entity;
  885. struct media_entity_graph graph;
  886. int ret;
  887. /*
  888. * Walk current graph and call the pipeline open/close routine for each
  889. * opened video node that belongs to the graph of entities connected
  890. * through active links. This is needed as we cannot power on/off the
  891. * subdevs in random order.
  892. */
  893. media_entity_graph_walk_start(&graph, entity);
  894. while ((entity = media_entity_graph_walk_next(&graph))) {
  895. if (media_entity_type(entity) != MEDIA_ENT_T_DEVNODE)
  896. continue;
  897. ret = __fimc_md_modify_pipeline(entity, enable);
  898. if (ret < 0)
  899. goto err;
  900. }
  901. return 0;
  902. err:
  903. media_entity_graph_walk_start(&graph, entity_err);
  904. while ((entity_err = media_entity_graph_walk_next(&graph))) {
  905. if (media_entity_type(entity_err) != MEDIA_ENT_T_DEVNODE)
  906. continue;
  907. __fimc_md_modify_pipeline(entity_err, !enable);
  908. if (entity_err == entity)
  909. break;
  910. }
  911. return ret;
  912. }
  913. static int fimc_md_link_notify(struct media_link *link, unsigned int flags,
  914. unsigned int notification)
  915. {
  916. struct media_entity *sink = link->sink->entity;
  917. int ret = 0;
  918. /* Before link disconnection */
  919. if (notification == MEDIA_DEV_NOTIFY_PRE_LINK_CH) {
  920. if (!(flags & MEDIA_LNK_FL_ENABLED))
  921. ret = __fimc_md_modify_pipelines(sink, false);
  922. else
  923. ; /* TODO: Link state change validation */
  924. /* After link activation */
  925. } else if (notification == MEDIA_DEV_NOTIFY_POST_LINK_CH &&
  926. (link->flags & MEDIA_LNK_FL_ENABLED)) {
  927. ret = __fimc_md_modify_pipelines(sink, true);
  928. }
  929. return ret ? -EPIPE : 0;
  930. }
  931. static ssize_t fimc_md_sysfs_show(struct device *dev,
  932. struct device_attribute *attr, char *buf)
  933. {
  934. struct platform_device *pdev = to_platform_device(dev);
  935. struct fimc_md *fmd = platform_get_drvdata(pdev);
  936. if (fmd->user_subdev_api)
  937. return strlcpy(buf, "Sub-device API (sub-dev)\n", PAGE_SIZE);
  938. return strlcpy(buf, "V4L2 video node only API (vid-dev)\n", PAGE_SIZE);
  939. }
  940. static ssize_t fimc_md_sysfs_store(struct device *dev,
  941. struct device_attribute *attr,
  942. const char *buf, size_t count)
  943. {
  944. struct platform_device *pdev = to_platform_device(dev);
  945. struct fimc_md *fmd = platform_get_drvdata(pdev);
  946. bool subdev_api;
  947. int i;
  948. if (!strcmp(buf, "vid-dev\n"))
  949. subdev_api = false;
  950. else if (!strcmp(buf, "sub-dev\n"))
  951. subdev_api = true;
  952. else
  953. return count;
  954. fmd->user_subdev_api = subdev_api;
  955. for (i = 0; i < FIMC_MAX_DEVS; i++)
  956. if (fmd->fimc[i])
  957. fmd->fimc[i]->vid_cap.user_subdev_api = subdev_api;
  958. return count;
  959. }
  960. /*
  961. * This device attribute is to select video pipeline configuration method.
  962. * There are following valid values:
  963. * vid-dev - for V4L2 video node API only, subdevice will be configured
  964. * by the host driver.
  965. * sub-dev - for media controller API, subdevs must be configured in user
  966. * space before starting streaming.
  967. */
  968. static DEVICE_ATTR(subdev_conf_mode, S_IWUSR | S_IRUGO,
  969. fimc_md_sysfs_show, fimc_md_sysfs_store);
  970. static int fimc_md_get_pinctrl(struct fimc_md *fmd)
  971. {
  972. struct device *dev = &fmd->pdev->dev;
  973. struct fimc_pinctrl *pctl = &fmd->pinctl;
  974. pctl->pinctrl = devm_pinctrl_get(dev);
  975. if (IS_ERR(pctl->pinctrl))
  976. return PTR_ERR(pctl->pinctrl);
  977. pctl->state_default = pinctrl_lookup_state(pctl->pinctrl,
  978. PINCTRL_STATE_DEFAULT);
  979. if (IS_ERR(pctl->state_default))
  980. return PTR_ERR(pctl->state_default);
  981. pctl->state_idle = pinctrl_lookup_state(pctl->pinctrl,
  982. PINCTRL_STATE_IDLE);
  983. return 0;
  984. }
  985. static int cam_clk_prepare(struct clk_hw *hw)
  986. {
  987. struct cam_clk *camclk = to_cam_clk(hw);
  988. int ret;
  989. if (camclk->fmd->pmf == NULL)
  990. return -ENODEV;
  991. ret = pm_runtime_get_sync(camclk->fmd->pmf);
  992. return ret < 0 ? ret : 0;
  993. }
  994. static void cam_clk_unprepare(struct clk_hw *hw)
  995. {
  996. struct cam_clk *camclk = to_cam_clk(hw);
  997. if (camclk->fmd->pmf == NULL)
  998. return;
  999. pm_runtime_put_sync(camclk->fmd->pmf);
  1000. }
  1001. static const struct clk_ops cam_clk_ops = {
  1002. .prepare = cam_clk_prepare,
  1003. .unprepare = cam_clk_unprepare,
  1004. };
  1005. static void fimc_md_unregister_clk_provider(struct fimc_md *fmd)
  1006. {
  1007. struct cam_clk_provider *cp = &fmd->clk_provider;
  1008. unsigned int i;
  1009. if (cp->of_node)
  1010. of_clk_del_provider(cp->of_node);
  1011. for (i = 0; i < cp->num_clocks; i++)
  1012. clk_unregister(cp->clks[i]);
  1013. }
  1014. static int fimc_md_register_clk_provider(struct fimc_md *fmd)
  1015. {
  1016. struct cam_clk_provider *cp = &fmd->clk_provider;
  1017. struct device *dev = &fmd->pdev->dev;
  1018. int i, ret;
  1019. for (i = 0; i < FIMC_MAX_CAMCLKS; i++) {
  1020. struct cam_clk *camclk = &cp->camclk[i];
  1021. struct clk_init_data init;
  1022. const char *p_name;
  1023. ret = of_property_read_string_index(dev->of_node,
  1024. "clock-output-names", i, &init.name);
  1025. if (ret < 0)
  1026. break;
  1027. p_name = __clk_get_name(fmd->camclk[i].clock);
  1028. /* It's safe since clk_register() will duplicate the string. */
  1029. init.parent_names = &p_name;
  1030. init.num_parents = 1;
  1031. init.ops = &cam_clk_ops;
  1032. init.flags = CLK_SET_RATE_PARENT;
  1033. camclk->hw.init = &init;
  1034. camclk->fmd = fmd;
  1035. cp->clks[i] = clk_register(NULL, &camclk->hw);
  1036. if (IS_ERR(cp->clks[i])) {
  1037. dev_err(dev, "failed to register clock: %s (%ld)\n",
  1038. init.name, PTR_ERR(cp->clks[i]));
  1039. ret = PTR_ERR(cp->clks[i]);
  1040. goto err;
  1041. }
  1042. cp->num_clocks++;
  1043. }
  1044. if (cp->num_clocks == 0) {
  1045. dev_warn(dev, "clk provider not registered\n");
  1046. return 0;
  1047. }
  1048. cp->clk_data.clks = cp->clks;
  1049. cp->clk_data.clk_num = cp->num_clocks;
  1050. cp->of_node = dev->of_node;
  1051. ret = of_clk_add_provider(dev->of_node, of_clk_src_onecell_get,
  1052. &cp->clk_data);
  1053. if (ret == 0)
  1054. return 0;
  1055. err:
  1056. fimc_md_unregister_clk_provider(fmd);
  1057. return ret;
  1058. }
  1059. static int subdev_notifier_bound(struct v4l2_async_notifier *notifier,
  1060. struct v4l2_subdev *subdev,
  1061. struct v4l2_async_subdev *asd)
  1062. {
  1063. struct fimc_md *fmd = notifier_to_fimc_md(notifier);
  1064. struct fimc_sensor_info *si = NULL;
  1065. int i;
  1066. /* Find platform data for this sensor subdev */
  1067. for (i = 0; i < ARRAY_SIZE(fmd->sensor); i++)
  1068. if (fmd->sensor[i].asd.match.of.node == subdev->dev->of_node)
  1069. si = &fmd->sensor[i];
  1070. if (si == NULL)
  1071. return -EINVAL;
  1072. v4l2_set_subdev_hostdata(subdev, &si->pdata);
  1073. if (si->pdata.fimc_bus_type == FIMC_BUS_TYPE_ISP_WRITEBACK)
  1074. subdev->grp_id = GRP_ID_FIMC_IS_SENSOR;
  1075. else
  1076. subdev->grp_id = GRP_ID_SENSOR;
  1077. si->subdev = subdev;
  1078. v4l2_info(&fmd->v4l2_dev, "Registered sensor subdevice: %s (%d)\n",
  1079. subdev->name, fmd->num_sensors);
  1080. fmd->num_sensors++;
  1081. return 0;
  1082. }
  1083. static int subdev_notifier_complete(struct v4l2_async_notifier *notifier)
  1084. {
  1085. struct fimc_md *fmd = notifier_to_fimc_md(notifier);
  1086. int ret;
  1087. mutex_lock(&fmd->media_dev.graph_mutex);
  1088. ret = fimc_md_create_links(fmd);
  1089. if (ret < 0)
  1090. goto unlock;
  1091. ret = v4l2_device_register_subdev_nodes(&fmd->v4l2_dev);
  1092. unlock:
  1093. mutex_unlock(&fmd->media_dev.graph_mutex);
  1094. return ret;
  1095. }
  1096. static int fimc_md_probe(struct platform_device *pdev)
  1097. {
  1098. struct device *dev = &pdev->dev;
  1099. struct v4l2_device *v4l2_dev;
  1100. struct fimc_md *fmd;
  1101. int ret;
  1102. fmd = devm_kzalloc(dev, sizeof(*fmd), GFP_KERNEL);
  1103. if (!fmd)
  1104. return -ENOMEM;
  1105. spin_lock_init(&fmd->slock);
  1106. INIT_LIST_HEAD(&fmd->pipelines);
  1107. fmd->pdev = pdev;
  1108. strlcpy(fmd->media_dev.model, "SAMSUNG S5P FIMC",
  1109. sizeof(fmd->media_dev.model));
  1110. fmd->media_dev.link_notify = fimc_md_link_notify;
  1111. fmd->media_dev.dev = dev;
  1112. v4l2_dev = &fmd->v4l2_dev;
  1113. v4l2_dev->mdev = &fmd->media_dev;
  1114. v4l2_dev->notify = fimc_sensor_notify;
  1115. strlcpy(v4l2_dev->name, "s5p-fimc-md", sizeof(v4l2_dev->name));
  1116. fmd->use_isp = fimc_md_is_isp_available(dev->of_node);
  1117. fmd->user_subdev_api = true;
  1118. ret = v4l2_device_register(dev, &fmd->v4l2_dev);
  1119. if (ret < 0) {
  1120. v4l2_err(v4l2_dev, "Failed to register v4l2_device: %d\n", ret);
  1121. return ret;
  1122. }
  1123. ret = media_device_register(&fmd->media_dev);
  1124. if (ret < 0) {
  1125. v4l2_err(v4l2_dev, "Failed to register media device: %d\n", ret);
  1126. goto err_v4l2_dev;
  1127. }
  1128. ret = fimc_md_get_clocks(fmd);
  1129. if (ret)
  1130. goto err_md;
  1131. ret = fimc_md_get_pinctrl(fmd);
  1132. if (ret < 0) {
  1133. if (ret != EPROBE_DEFER)
  1134. dev_err(dev, "Failed to get pinctrl: %d\n", ret);
  1135. goto err_clk;
  1136. }
  1137. platform_set_drvdata(pdev, fmd);
  1138. /* Protect the media graph while we're registering entities */
  1139. mutex_lock(&fmd->media_dev.graph_mutex);
  1140. ret = fimc_md_register_platform_entities(fmd, dev->of_node);
  1141. if (ret) {
  1142. mutex_unlock(&fmd->media_dev.graph_mutex);
  1143. goto err_clk;
  1144. }
  1145. ret = fimc_md_register_sensor_entities(fmd);
  1146. if (ret) {
  1147. mutex_unlock(&fmd->media_dev.graph_mutex);
  1148. goto err_m_ent;
  1149. }
  1150. mutex_unlock(&fmd->media_dev.graph_mutex);
  1151. ret = device_create_file(&pdev->dev, &dev_attr_subdev_conf_mode);
  1152. if (ret)
  1153. goto err_m_ent;
  1154. /*
  1155. * FIMC platform devices need to be registered before the sclk_cam
  1156. * clocks provider, as one of these devices needs to be activated
  1157. * to enable the clock.
  1158. */
  1159. ret = fimc_md_register_clk_provider(fmd);
  1160. if (ret < 0) {
  1161. v4l2_err(v4l2_dev, "clock provider registration failed\n");
  1162. goto err_attr;
  1163. }
  1164. if (fmd->num_sensors > 0) {
  1165. fmd->subdev_notifier.subdevs = fmd->async_subdevs;
  1166. fmd->subdev_notifier.num_subdevs = fmd->num_sensors;
  1167. fmd->subdev_notifier.bound = subdev_notifier_bound;
  1168. fmd->subdev_notifier.complete = subdev_notifier_complete;
  1169. fmd->num_sensors = 0;
  1170. ret = v4l2_async_notifier_register(&fmd->v4l2_dev,
  1171. &fmd->subdev_notifier);
  1172. if (ret)
  1173. goto err_clk_p;
  1174. }
  1175. return 0;
  1176. err_clk_p:
  1177. fimc_md_unregister_clk_provider(fmd);
  1178. err_attr:
  1179. device_remove_file(&pdev->dev, &dev_attr_subdev_conf_mode);
  1180. err_clk:
  1181. fimc_md_put_clocks(fmd);
  1182. err_m_ent:
  1183. fimc_md_unregister_entities(fmd);
  1184. err_md:
  1185. media_device_unregister(&fmd->media_dev);
  1186. err_v4l2_dev:
  1187. v4l2_device_unregister(&fmd->v4l2_dev);
  1188. return ret;
  1189. }
  1190. static int fimc_md_remove(struct platform_device *pdev)
  1191. {
  1192. struct fimc_md *fmd = platform_get_drvdata(pdev);
  1193. if (!fmd)
  1194. return 0;
  1195. fimc_md_unregister_clk_provider(fmd);
  1196. v4l2_async_notifier_unregister(&fmd->subdev_notifier);
  1197. v4l2_device_unregister(&fmd->v4l2_dev);
  1198. device_remove_file(&pdev->dev, &dev_attr_subdev_conf_mode);
  1199. fimc_md_unregister_entities(fmd);
  1200. fimc_md_pipelines_free(fmd);
  1201. media_device_unregister(&fmd->media_dev);
  1202. fimc_md_put_clocks(fmd);
  1203. return 0;
  1204. }
  1205. static struct platform_device_id fimc_driver_ids[] __always_unused = {
  1206. { .name = "s5p-fimc-md" },
  1207. { },
  1208. };
  1209. MODULE_DEVICE_TABLE(platform, fimc_driver_ids);
  1210. static const struct of_device_id fimc_md_of_match[] = {
  1211. { .compatible = "samsung,fimc" },
  1212. { },
  1213. };
  1214. MODULE_DEVICE_TABLE(of, fimc_md_of_match);
  1215. static struct platform_driver fimc_md_driver = {
  1216. .probe = fimc_md_probe,
  1217. .remove = fimc_md_remove,
  1218. .driver = {
  1219. .of_match_table = of_match_ptr(fimc_md_of_match),
  1220. .name = "s5p-fimc-md",
  1221. .owner = THIS_MODULE,
  1222. }
  1223. };
  1224. static int __init fimc_md_init(void)
  1225. {
  1226. int ret;
  1227. request_module("s5p-csis");
  1228. ret = fimc_register_driver();
  1229. if (ret)
  1230. return ret;
  1231. return platform_driver_register(&fimc_md_driver);
  1232. }
  1233. static void __exit fimc_md_exit(void)
  1234. {
  1235. platform_driver_unregister(&fimc_md_driver);
  1236. fimc_unregister_driver();
  1237. }
  1238. module_init(fimc_md_init);
  1239. module_exit(fimc_md_exit);
  1240. MODULE_AUTHOR("Sylwester Nawrocki <s.nawrocki@samsung.com>");
  1241. MODULE_DESCRIPTION("S5P FIMC camera host interface/video postprocessor driver");
  1242. MODULE_LICENSE("GPL");
  1243. MODULE_VERSION("2.0.1");