apply.c 29 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442
  1. /*
  2. * Copyright (C) 2011 Texas Instruments
  3. * Author: Tomi Valkeinen <tomi.valkeinen@ti.com>
  4. *
  5. * This program is free software; you can redistribute it and/or modify it
  6. * under the terms of the GNU General Public License version 2 as published by
  7. * the Free Software Foundation.
  8. *
  9. * This program is distributed in the hope that it will be useful, but WITHOUT
  10. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  12. * more details.
  13. *
  14. * You should have received a copy of the GNU General Public License along with
  15. * this program. If not, see <http://www.gnu.org/licenses/>.
  16. */
  17. #define DSS_SUBSYS_NAME "APPLY"
  18. #include <linux/kernel.h>
  19. #include <linux/slab.h>
  20. #include <linux/spinlock.h>
  21. #include <linux/jiffies.h>
  22. #include <video/omapdss.h>
  23. #include "dss.h"
  24. #include "dss_features.h"
  25. /*
  26. * We have 4 levels of cache for the dispc settings. First two are in SW and
  27. * the latter two in HW.
  28. *
  29. * set_info()
  30. * v
  31. * +--------------------+
  32. * | user_info |
  33. * +--------------------+
  34. * v
  35. * apply()
  36. * v
  37. * +--------------------+
  38. * | info |
  39. * +--------------------+
  40. * v
  41. * write_regs()
  42. * v
  43. * +--------------------+
  44. * | shadow registers |
  45. * +--------------------+
  46. * v
  47. * VFP or lcd/digit_enable
  48. * v
  49. * +--------------------+
  50. * | registers |
  51. * +--------------------+
  52. */
  53. struct ovl_priv_data {
  54. bool user_info_dirty;
  55. struct omap_overlay_info user_info;
  56. bool info_dirty;
  57. struct omap_overlay_info info;
  58. bool shadow_info_dirty;
  59. bool extra_info_dirty;
  60. bool shadow_extra_info_dirty;
  61. bool enabled;
  62. enum omap_channel channel;
  63. u32 fifo_low, fifo_high;
  64. };
  65. struct mgr_priv_data {
  66. bool user_info_dirty;
  67. struct omap_overlay_manager_info user_info;
  68. bool info_dirty;
  69. struct omap_overlay_manager_info info;
  70. bool shadow_info_dirty;
  71. /* If true, GO bit is up and shadow registers cannot be written.
  72. * Never true for manual update displays */
  73. bool busy;
  74. /* If true, dispc output is enabled */
  75. bool updating;
  76. /* If true, a display is enabled using this manager */
  77. bool enabled;
  78. };
  79. static struct {
  80. struct ovl_priv_data ovl_priv_data_array[MAX_DSS_OVERLAYS];
  81. struct mgr_priv_data mgr_priv_data_array[MAX_DSS_MANAGERS];
  82. bool irq_enabled;
  83. } dss_data;
  84. /* protects dss_data */
  85. static spinlock_t data_lock;
  86. /* lock for blocking functions */
  87. static DEFINE_MUTEX(apply_lock);
  88. static DECLARE_COMPLETION(extra_updated_completion);
  89. static void dss_register_vsync_isr(void);
  90. static struct ovl_priv_data *get_ovl_priv(struct omap_overlay *ovl)
  91. {
  92. return &dss_data.ovl_priv_data_array[ovl->id];
  93. }
  94. static struct mgr_priv_data *get_mgr_priv(struct omap_overlay_manager *mgr)
  95. {
  96. return &dss_data.mgr_priv_data_array[mgr->id];
  97. }
  98. void dss_apply_init(void)
  99. {
  100. const int num_ovls = dss_feat_get_num_ovls();
  101. int i;
  102. spin_lock_init(&data_lock);
  103. for (i = 0; i < num_ovls; ++i) {
  104. struct ovl_priv_data *op;
  105. op = &dss_data.ovl_priv_data_array[i];
  106. op->info.global_alpha = 255;
  107. switch (i) {
  108. case 0:
  109. op->info.zorder = 0;
  110. break;
  111. case 1:
  112. op->info.zorder =
  113. dss_has_feature(FEAT_ALPHA_FREE_ZORDER) ? 3 : 0;
  114. break;
  115. case 2:
  116. op->info.zorder =
  117. dss_has_feature(FEAT_ALPHA_FREE_ZORDER) ? 2 : 0;
  118. break;
  119. case 3:
  120. op->info.zorder =
  121. dss_has_feature(FEAT_ALPHA_FREE_ZORDER) ? 1 : 0;
  122. break;
  123. }
  124. op->user_info = op->info;
  125. }
  126. }
  127. static bool ovl_manual_update(struct omap_overlay *ovl)
  128. {
  129. return ovl->manager->device->caps & OMAP_DSS_DISPLAY_CAP_MANUAL_UPDATE;
  130. }
  131. static bool mgr_manual_update(struct omap_overlay_manager *mgr)
  132. {
  133. return mgr->device->caps & OMAP_DSS_DISPLAY_CAP_MANUAL_UPDATE;
  134. }
  135. /* Check if overlay parameters are compatible with display */
  136. static int dss_ovl_check(struct omap_overlay *ovl,
  137. struct omap_overlay_info *info, struct omap_dss_device *dssdev)
  138. {
  139. u16 outw, outh;
  140. u16 dw, dh;
  141. if (dssdev == NULL)
  142. return 0;
  143. dssdev->driver->get_resolution(dssdev, &dw, &dh);
  144. if ((ovl->caps & OMAP_DSS_OVL_CAP_SCALE) == 0) {
  145. outw = info->width;
  146. outh = info->height;
  147. } else {
  148. if (info->out_width == 0)
  149. outw = info->width;
  150. else
  151. outw = info->out_width;
  152. if (info->out_height == 0)
  153. outh = info->height;
  154. else
  155. outh = info->out_height;
  156. }
  157. if (dw < info->pos_x + outw) {
  158. DSSERR("overlay %d horizontally not inside the display area "
  159. "(%d + %d >= %d)\n",
  160. ovl->id, info->pos_x, outw, dw);
  161. return -EINVAL;
  162. }
  163. if (dh < info->pos_y + outh) {
  164. DSSERR("overlay %d vertically not inside the display area "
  165. "(%d + %d >= %d)\n",
  166. ovl->id, info->pos_y, outh, dh);
  167. return -EINVAL;
  168. }
  169. return 0;
  170. }
  171. static int dss_mgr_check_zorder(struct omap_overlay_manager *mgr,
  172. struct omap_overlay_info **overlay_infos)
  173. {
  174. struct omap_overlay *ovl1, *ovl2;
  175. struct ovl_priv_data *op1, *op2;
  176. struct omap_overlay_info *info1, *info2;
  177. list_for_each_entry(ovl1, &mgr->overlays, list) {
  178. op1 = get_ovl_priv(ovl1);
  179. info1 = overlay_infos[ovl1->id];
  180. if (info1 == NULL)
  181. continue;
  182. list_for_each_entry(ovl2, &mgr->overlays, list) {
  183. if (ovl1 == ovl2)
  184. continue;
  185. op2 = get_ovl_priv(ovl2);
  186. info2 = overlay_infos[ovl2->id];
  187. if (info2 == NULL)
  188. continue;
  189. if (info1->zorder == info2->zorder) {
  190. DSSERR("overlays %d and %d have the same "
  191. "zorder %d\n",
  192. ovl1->id, ovl2->id, info1->zorder);
  193. return -EINVAL;
  194. }
  195. }
  196. }
  197. return 0;
  198. }
  199. static int dss_mgr_check(struct omap_overlay_manager *mgr,
  200. struct omap_dss_device *dssdev,
  201. struct omap_overlay_manager_info *info,
  202. struct omap_overlay_info **overlay_infos)
  203. {
  204. struct omap_overlay *ovl;
  205. int r;
  206. if (dss_has_feature(FEAT_ALPHA_FREE_ZORDER)) {
  207. r = dss_mgr_check_zorder(mgr, overlay_infos);
  208. if (r)
  209. return r;
  210. }
  211. list_for_each_entry(ovl, &mgr->overlays, list) {
  212. struct omap_overlay_info *oi;
  213. int r;
  214. oi = overlay_infos[ovl->id];
  215. if (oi == NULL)
  216. continue;
  217. r = dss_ovl_check(ovl, oi, dssdev);
  218. if (r)
  219. return r;
  220. }
  221. return 0;
  222. }
  223. static int dss_check_settings_low(struct omap_overlay_manager *mgr,
  224. struct omap_dss_device *dssdev, bool applying)
  225. {
  226. struct omap_overlay_info *oi;
  227. struct omap_overlay_manager_info *mi;
  228. struct omap_overlay *ovl;
  229. struct omap_overlay_info *ois[MAX_DSS_OVERLAYS];
  230. struct ovl_priv_data *op;
  231. struct mgr_priv_data *mp;
  232. mp = get_mgr_priv(mgr);
  233. if (applying && mp->user_info_dirty)
  234. mi = &mp->user_info;
  235. else
  236. mi = &mp->info;
  237. /* collect the infos to be tested into the array */
  238. list_for_each_entry(ovl, &mgr->overlays, list) {
  239. op = get_ovl_priv(ovl);
  240. if (!op->enabled)
  241. oi = NULL;
  242. else if (applying && op->user_info_dirty)
  243. oi = &op->user_info;
  244. else
  245. oi = &op->info;
  246. ois[ovl->id] = oi;
  247. }
  248. return dss_mgr_check(mgr, dssdev, mi, ois);
  249. }
  250. /*
  251. * check manager and overlay settings using overlay_info from data->info
  252. */
  253. static int dss_check_settings(struct omap_overlay_manager *mgr,
  254. struct omap_dss_device *dssdev)
  255. {
  256. return dss_check_settings_low(mgr, dssdev, false);
  257. }
  258. /*
  259. * check manager and overlay settings using overlay_info from ovl->info if
  260. * dirty and from data->info otherwise
  261. */
  262. static int dss_check_settings_apply(struct omap_overlay_manager *mgr,
  263. struct omap_dss_device *dssdev)
  264. {
  265. return dss_check_settings_low(mgr, dssdev, true);
  266. }
  267. static bool need_isr(void)
  268. {
  269. const int num_mgrs = dss_feat_get_num_mgrs();
  270. int i;
  271. for (i = 0; i < num_mgrs; ++i) {
  272. struct omap_overlay_manager *mgr;
  273. struct mgr_priv_data *mp;
  274. struct omap_overlay *ovl;
  275. mgr = omap_dss_get_overlay_manager(i);
  276. mp = get_mgr_priv(mgr);
  277. if (!mp->enabled)
  278. continue;
  279. if (mgr_manual_update(mgr)) {
  280. /* to catch FRAMEDONE */
  281. if (mp->updating)
  282. return true;
  283. } else {
  284. /* to catch GO bit going down */
  285. if (mp->busy)
  286. return true;
  287. /* to write new values to registers */
  288. if (mp->info_dirty)
  289. return true;
  290. /* to set GO bit */
  291. if (mp->shadow_info_dirty)
  292. return true;
  293. list_for_each_entry(ovl, &mgr->overlays, list) {
  294. struct ovl_priv_data *op;
  295. op = get_ovl_priv(ovl);
  296. /*
  297. * NOTE: we check extra_info flags even for
  298. * disabled overlays, as extra_infos need to be
  299. * always written.
  300. */
  301. /* to write new values to registers */
  302. if (op->extra_info_dirty)
  303. return true;
  304. /* to set GO bit */
  305. if (op->shadow_extra_info_dirty)
  306. return true;
  307. if (!op->enabled)
  308. continue;
  309. /* to write new values to registers */
  310. if (op->info_dirty)
  311. return true;
  312. /* to set GO bit */
  313. if (op->shadow_info_dirty)
  314. return true;
  315. }
  316. }
  317. }
  318. return false;
  319. }
  320. static bool need_go(struct omap_overlay_manager *mgr)
  321. {
  322. struct omap_overlay *ovl;
  323. struct mgr_priv_data *mp;
  324. struct ovl_priv_data *op;
  325. mp = get_mgr_priv(mgr);
  326. if (mp->shadow_info_dirty)
  327. return true;
  328. list_for_each_entry(ovl, &mgr->overlays, list) {
  329. op = get_ovl_priv(ovl);
  330. if (op->shadow_info_dirty || op->shadow_extra_info_dirty)
  331. return true;
  332. }
  333. return false;
  334. }
  335. /* returns true if an extra_info field is currently being updated */
  336. static bool extra_info_update_ongoing(void)
  337. {
  338. const int num_ovls = omap_dss_get_num_overlays();
  339. struct ovl_priv_data *op;
  340. struct omap_overlay *ovl;
  341. struct mgr_priv_data *mp;
  342. int i;
  343. bool eid;
  344. for (i = 0; i < num_ovls; ++i) {
  345. ovl = omap_dss_get_overlay(i);
  346. op = get_ovl_priv(ovl);
  347. mp = get_mgr_priv(ovl->manager);
  348. if (!mp->enabled)
  349. continue;
  350. eid = op->extra_info_dirty || op->shadow_extra_info_dirty;
  351. if (!eid)
  352. continue;
  353. if (ovl_manual_update(ovl) && !mp->updating)
  354. continue;
  355. return true;
  356. }
  357. return false;
  358. }
  359. /* wait until no extra_info updates are pending */
  360. static void wait_pending_extra_info_updates(void)
  361. {
  362. bool updating;
  363. unsigned long flags;
  364. unsigned long t;
  365. spin_lock_irqsave(&data_lock, flags);
  366. updating = extra_info_update_ongoing();
  367. if (!updating) {
  368. spin_unlock_irqrestore(&data_lock, flags);
  369. return;
  370. }
  371. init_completion(&extra_updated_completion);
  372. spin_unlock_irqrestore(&data_lock, flags);
  373. t = msecs_to_jiffies(500);
  374. wait_for_completion_timeout(&extra_updated_completion, t);
  375. updating = extra_info_update_ongoing();
  376. WARN_ON(updating);
  377. }
  378. int dss_mgr_wait_for_go(struct omap_overlay_manager *mgr)
  379. {
  380. unsigned long timeout = msecs_to_jiffies(500);
  381. struct mgr_priv_data *mp;
  382. u32 irq;
  383. int r;
  384. int i;
  385. struct omap_dss_device *dssdev = mgr->device;
  386. if (!dssdev || dssdev->state != OMAP_DSS_DISPLAY_ACTIVE)
  387. return 0;
  388. if (mgr_manual_update(mgr))
  389. return 0;
  390. irq = dispc_mgr_get_vsync_irq(mgr->id);
  391. mp = get_mgr_priv(mgr);
  392. i = 0;
  393. while (1) {
  394. unsigned long flags;
  395. bool shadow_dirty, dirty;
  396. spin_lock_irqsave(&data_lock, flags);
  397. dirty = mp->info_dirty;
  398. shadow_dirty = mp->shadow_info_dirty;
  399. spin_unlock_irqrestore(&data_lock, flags);
  400. if (!dirty && !shadow_dirty) {
  401. r = 0;
  402. break;
  403. }
  404. /* 4 iterations is the worst case:
  405. * 1 - initial iteration, dirty = true (between VFP and VSYNC)
  406. * 2 - first VSYNC, dirty = true
  407. * 3 - dirty = false, shadow_dirty = true
  408. * 4 - shadow_dirty = false */
  409. if (i++ == 3) {
  410. DSSERR("mgr(%d)->wait_for_go() not finishing\n",
  411. mgr->id);
  412. r = 0;
  413. break;
  414. }
  415. r = omap_dispc_wait_for_irq_interruptible_timeout(irq, timeout);
  416. if (r == -ERESTARTSYS)
  417. break;
  418. if (r) {
  419. DSSERR("mgr(%d)->wait_for_go() timeout\n", mgr->id);
  420. break;
  421. }
  422. }
  423. return r;
  424. }
  425. int dss_mgr_wait_for_go_ovl(struct omap_overlay *ovl)
  426. {
  427. unsigned long timeout = msecs_to_jiffies(500);
  428. struct ovl_priv_data *op;
  429. struct omap_dss_device *dssdev;
  430. u32 irq;
  431. int r;
  432. int i;
  433. if (!ovl->manager)
  434. return 0;
  435. dssdev = ovl->manager->device;
  436. if (!dssdev || dssdev->state != OMAP_DSS_DISPLAY_ACTIVE)
  437. return 0;
  438. if (ovl_manual_update(ovl))
  439. return 0;
  440. irq = dispc_mgr_get_vsync_irq(ovl->manager->id);
  441. op = get_ovl_priv(ovl);
  442. i = 0;
  443. while (1) {
  444. unsigned long flags;
  445. bool shadow_dirty, dirty;
  446. spin_lock_irqsave(&data_lock, flags);
  447. dirty = op->info_dirty;
  448. shadow_dirty = op->shadow_info_dirty;
  449. spin_unlock_irqrestore(&data_lock, flags);
  450. if (!dirty && !shadow_dirty) {
  451. r = 0;
  452. break;
  453. }
  454. /* 4 iterations is the worst case:
  455. * 1 - initial iteration, dirty = true (between VFP and VSYNC)
  456. * 2 - first VSYNC, dirty = true
  457. * 3 - dirty = false, shadow_dirty = true
  458. * 4 - shadow_dirty = false */
  459. if (i++ == 3) {
  460. DSSERR("ovl(%d)->wait_for_go() not finishing\n",
  461. ovl->id);
  462. r = 0;
  463. break;
  464. }
  465. r = omap_dispc_wait_for_irq_interruptible_timeout(irq, timeout);
  466. if (r == -ERESTARTSYS)
  467. break;
  468. if (r) {
  469. DSSERR("ovl(%d)->wait_for_go() timeout\n", ovl->id);
  470. break;
  471. }
  472. }
  473. return r;
  474. }
  475. static void dss_ovl_write_regs(struct omap_overlay *ovl)
  476. {
  477. struct ovl_priv_data *op = get_ovl_priv(ovl);
  478. struct omap_overlay_info *oi;
  479. bool ilace, replication;
  480. struct mgr_priv_data *mp;
  481. int r;
  482. DSSDBGF("%d", ovl->id);
  483. if (!op->enabled || !op->info_dirty)
  484. return;
  485. oi = &op->info;
  486. replication = dss_use_replication(ovl->manager->device, oi->color_mode);
  487. ilace = ovl->manager->device->type == OMAP_DISPLAY_TYPE_VENC;
  488. r = dispc_ovl_setup(ovl->id, oi, ilace, replication);
  489. if (r) {
  490. /*
  491. * We can't do much here, as this function can be called from
  492. * vsync interrupt.
  493. */
  494. DSSERR("dispc_ovl_setup failed for ovl %d\n", ovl->id);
  495. /* This will leave fifo configurations in a nonoptimal state */
  496. op->enabled = false;
  497. dispc_ovl_enable(ovl->id, false);
  498. return;
  499. }
  500. mp = get_mgr_priv(ovl->manager);
  501. op->info_dirty = false;
  502. if (mp->updating)
  503. op->shadow_info_dirty = true;
  504. }
  505. static void dss_ovl_write_regs_extra(struct omap_overlay *ovl)
  506. {
  507. struct ovl_priv_data *op = get_ovl_priv(ovl);
  508. struct mgr_priv_data *mp;
  509. DSSDBGF("%d", ovl->id);
  510. if (!op->extra_info_dirty)
  511. return;
  512. /* note: write also when op->enabled == false, so that the ovl gets
  513. * disabled */
  514. dispc_ovl_enable(ovl->id, op->enabled);
  515. dispc_ovl_set_channel_out(ovl->id, op->channel);
  516. dispc_ovl_set_fifo_threshold(ovl->id, op->fifo_low, op->fifo_high);
  517. mp = get_mgr_priv(ovl->manager);
  518. op->extra_info_dirty = false;
  519. if (mp->updating)
  520. op->shadow_extra_info_dirty = true;
  521. }
  522. static void dss_mgr_write_regs(struct omap_overlay_manager *mgr)
  523. {
  524. struct mgr_priv_data *mp = get_mgr_priv(mgr);
  525. struct omap_overlay *ovl;
  526. DSSDBGF("%d", mgr->id);
  527. if (!mp->enabled)
  528. return;
  529. WARN_ON(mp->busy);
  530. /* Commit overlay settings */
  531. list_for_each_entry(ovl, &mgr->overlays, list) {
  532. dss_ovl_write_regs(ovl);
  533. dss_ovl_write_regs_extra(ovl);
  534. }
  535. if (mp->info_dirty) {
  536. dispc_mgr_setup(mgr->id, &mp->info);
  537. mp->info_dirty = false;
  538. if (mp->updating)
  539. mp->shadow_info_dirty = true;
  540. }
  541. }
  542. static void dss_write_regs(void)
  543. {
  544. const int num_mgrs = omap_dss_get_num_overlay_managers();
  545. int i;
  546. for (i = 0; i < num_mgrs; ++i) {
  547. struct omap_overlay_manager *mgr;
  548. struct mgr_priv_data *mp;
  549. int r;
  550. mgr = omap_dss_get_overlay_manager(i);
  551. mp = get_mgr_priv(mgr);
  552. if (!mp->enabled || mgr_manual_update(mgr) || mp->busy)
  553. continue;
  554. r = dss_check_settings(mgr, mgr->device);
  555. if (r) {
  556. DSSERR("cannot write registers for manager %s: "
  557. "illegal configuration\n", mgr->name);
  558. continue;
  559. }
  560. dss_mgr_write_regs(mgr);
  561. if (need_go(mgr)) {
  562. mp->busy = true;
  563. if (!dss_data.irq_enabled && need_isr())
  564. dss_register_vsync_isr();
  565. dispc_mgr_go(mgr->id);
  566. }
  567. }
  568. }
  569. void dss_mgr_start_update(struct omap_overlay_manager *mgr)
  570. {
  571. struct mgr_priv_data *mp = get_mgr_priv(mgr);
  572. unsigned long flags;
  573. int r;
  574. spin_lock_irqsave(&data_lock, flags);
  575. WARN_ON(mp->updating);
  576. r = dss_check_settings(mgr, mgr->device);
  577. if (r) {
  578. DSSERR("cannot start manual update: illegal configuration\n");
  579. spin_unlock_irqrestore(&data_lock, flags);
  580. return;
  581. }
  582. dss_mgr_write_regs(mgr);
  583. mp->updating = true;
  584. if (!dss_data.irq_enabled && need_isr())
  585. dss_register_vsync_isr();
  586. dispc_mgr_enable(mgr->id, true);
  587. spin_unlock_irqrestore(&data_lock, flags);
  588. }
  589. static void dss_apply_irq_handler(void *data, u32 mask);
  590. static void dss_register_vsync_isr(void)
  591. {
  592. const int num_mgrs = dss_feat_get_num_mgrs();
  593. u32 mask;
  594. int r, i;
  595. mask = 0;
  596. for (i = 0; i < num_mgrs; ++i)
  597. mask |= dispc_mgr_get_vsync_irq(i);
  598. for (i = 0; i < num_mgrs; ++i)
  599. mask |= dispc_mgr_get_framedone_irq(i);
  600. r = omap_dispc_register_isr(dss_apply_irq_handler, NULL, mask);
  601. WARN_ON(r);
  602. dss_data.irq_enabled = true;
  603. }
  604. static void dss_unregister_vsync_isr(void)
  605. {
  606. const int num_mgrs = dss_feat_get_num_mgrs();
  607. u32 mask;
  608. int r, i;
  609. mask = 0;
  610. for (i = 0; i < num_mgrs; ++i)
  611. mask |= dispc_mgr_get_vsync_irq(i);
  612. for (i = 0; i < num_mgrs; ++i)
  613. mask |= dispc_mgr_get_framedone_irq(i);
  614. r = omap_dispc_unregister_isr(dss_apply_irq_handler, NULL, mask);
  615. WARN_ON(r);
  616. dss_data.irq_enabled = false;
  617. }
  618. static void mgr_clear_shadow_dirty(struct omap_overlay_manager *mgr)
  619. {
  620. struct omap_overlay *ovl;
  621. struct mgr_priv_data *mp;
  622. struct ovl_priv_data *op;
  623. mp = get_mgr_priv(mgr);
  624. mp->shadow_info_dirty = false;
  625. list_for_each_entry(ovl, &mgr->overlays, list) {
  626. op = get_ovl_priv(ovl);
  627. op->shadow_info_dirty = false;
  628. op->shadow_extra_info_dirty = false;
  629. }
  630. }
  631. static void dss_apply_irq_handler(void *data, u32 mask)
  632. {
  633. const int num_mgrs = dss_feat_get_num_mgrs();
  634. int i;
  635. bool extra_updating;
  636. spin_lock(&data_lock);
  637. /* clear busy, updating flags, shadow_dirty flags */
  638. for (i = 0; i < num_mgrs; i++) {
  639. struct omap_overlay_manager *mgr;
  640. struct mgr_priv_data *mp;
  641. bool was_updating;
  642. mgr = omap_dss_get_overlay_manager(i);
  643. mp = get_mgr_priv(mgr);
  644. if (!mp->enabled)
  645. continue;
  646. was_updating = mp->updating;
  647. mp->updating = dispc_mgr_is_enabled(i);
  648. if (!mgr_manual_update(mgr)) {
  649. bool was_busy = mp->busy;
  650. mp->busy = dispc_mgr_go_busy(i);
  651. if (was_busy && !mp->busy)
  652. mgr_clear_shadow_dirty(mgr);
  653. } else {
  654. if (was_updating && !mp->updating)
  655. mgr_clear_shadow_dirty(mgr);
  656. }
  657. }
  658. dss_write_regs();
  659. extra_updating = extra_info_update_ongoing();
  660. if (!extra_updating)
  661. complete_all(&extra_updated_completion);
  662. if (!need_isr())
  663. dss_unregister_vsync_isr();
  664. spin_unlock(&data_lock);
  665. }
  666. static void omap_dss_mgr_apply_ovl(struct omap_overlay *ovl)
  667. {
  668. struct ovl_priv_data *op;
  669. op = get_ovl_priv(ovl);
  670. if (!op->user_info_dirty)
  671. return;
  672. op->user_info_dirty = false;
  673. op->info_dirty = true;
  674. op->info = op->user_info;
  675. }
  676. static void omap_dss_mgr_apply_mgr(struct omap_overlay_manager *mgr)
  677. {
  678. struct mgr_priv_data *mp;
  679. mp = get_mgr_priv(mgr);
  680. if (!mp->user_info_dirty)
  681. return;
  682. mp->user_info_dirty = false;
  683. mp->info_dirty = true;
  684. mp->info = mp->user_info;
  685. }
  686. int omap_dss_mgr_apply(struct omap_overlay_manager *mgr)
  687. {
  688. unsigned long flags;
  689. struct omap_overlay *ovl;
  690. int r;
  691. DSSDBG("omap_dss_mgr_apply(%s)\n", mgr->name);
  692. spin_lock_irqsave(&data_lock, flags);
  693. r = dss_check_settings_apply(mgr, mgr->device);
  694. if (r) {
  695. spin_unlock_irqrestore(&data_lock, flags);
  696. DSSERR("failed to apply settings: illegal configuration.\n");
  697. return r;
  698. }
  699. /* Configure overlays */
  700. list_for_each_entry(ovl, &mgr->overlays, list)
  701. omap_dss_mgr_apply_ovl(ovl);
  702. /* Configure manager */
  703. omap_dss_mgr_apply_mgr(mgr);
  704. dss_write_regs();
  705. spin_unlock_irqrestore(&data_lock, flags);
  706. return 0;
  707. }
  708. static void dss_apply_ovl_enable(struct omap_overlay *ovl, bool enable)
  709. {
  710. struct ovl_priv_data *op;
  711. op = get_ovl_priv(ovl);
  712. if (op->enabled == enable)
  713. return;
  714. op->enabled = enable;
  715. op->extra_info_dirty = true;
  716. }
  717. static void dss_ovl_setup_fifo(struct omap_overlay *ovl)
  718. {
  719. struct ovl_priv_data *op = get_ovl_priv(ovl);
  720. struct omap_dss_device *dssdev;
  721. u32 size, burst_size;
  722. u32 fifo_low, fifo_high;
  723. dssdev = ovl->manager->device;
  724. size = dispc_ovl_get_fifo_size(ovl->id);
  725. burst_size = dispc_ovl_get_burst_size(ovl->id);
  726. switch (dssdev->type) {
  727. case OMAP_DISPLAY_TYPE_DPI:
  728. case OMAP_DISPLAY_TYPE_DBI:
  729. case OMAP_DISPLAY_TYPE_SDI:
  730. case OMAP_DISPLAY_TYPE_VENC:
  731. case OMAP_DISPLAY_TYPE_HDMI:
  732. default_get_overlay_fifo_thresholds(ovl->id, size,
  733. burst_size, &fifo_low, &fifo_high);
  734. break;
  735. #ifdef CONFIG_OMAP2_DSS_DSI
  736. case OMAP_DISPLAY_TYPE_DSI:
  737. dsi_get_overlay_fifo_thresholds(ovl->id, size,
  738. burst_size, &fifo_low, &fifo_high);
  739. break;
  740. #endif
  741. default:
  742. BUG();
  743. }
  744. op->fifo_low = fifo_low;
  745. op->fifo_high = fifo_high;
  746. op->extra_info_dirty = true;
  747. }
  748. static void dss_mgr_setup_fifos(struct omap_overlay_manager *mgr)
  749. {
  750. struct omap_overlay *ovl;
  751. struct ovl_priv_data *op;
  752. struct mgr_priv_data *mp;
  753. mp = get_mgr_priv(mgr);
  754. if (!mp->enabled)
  755. return;
  756. list_for_each_entry(ovl, &mgr->overlays, list) {
  757. op = get_ovl_priv(ovl);
  758. if (!op->enabled)
  759. continue;
  760. dss_ovl_setup_fifo(ovl);
  761. }
  762. }
  763. int dss_mgr_enable(struct omap_overlay_manager *mgr)
  764. {
  765. struct mgr_priv_data *mp = get_mgr_priv(mgr);
  766. unsigned long flags;
  767. int r;
  768. mutex_lock(&apply_lock);
  769. if (mp->enabled)
  770. goto out;
  771. spin_lock_irqsave(&data_lock, flags);
  772. mp->enabled = true;
  773. r = dss_check_settings(mgr, mgr->device);
  774. mp->enabled = false;
  775. if (r) {
  776. DSSERR("failed to enable manager %d: check_settings failed\n",
  777. mgr->id);
  778. goto err;
  779. }
  780. mp->enabled = true;
  781. dss_mgr_setup_fifos(mgr);
  782. dss_write_regs();
  783. if (!mgr_manual_update(mgr))
  784. mp->updating = true;
  785. spin_unlock_irqrestore(&data_lock, flags);
  786. if (!mgr_manual_update(mgr))
  787. dispc_mgr_enable(mgr->id, true);
  788. out:
  789. mutex_unlock(&apply_lock);
  790. return 0;
  791. err:
  792. spin_unlock_irqrestore(&data_lock, flags);
  793. mutex_unlock(&apply_lock);
  794. return r;
  795. }
  796. void dss_mgr_disable(struct omap_overlay_manager *mgr)
  797. {
  798. struct mgr_priv_data *mp = get_mgr_priv(mgr);
  799. unsigned long flags;
  800. mutex_lock(&apply_lock);
  801. if (!mp->enabled)
  802. goto out;
  803. if (!mgr_manual_update(mgr))
  804. dispc_mgr_enable(mgr->id, false);
  805. spin_lock_irqsave(&data_lock, flags);
  806. mp->updating = false;
  807. mp->enabled = false;
  808. spin_unlock_irqrestore(&data_lock, flags);
  809. out:
  810. mutex_unlock(&apply_lock);
  811. }
  812. static int dss_mgr_simple_check(struct omap_overlay_manager *mgr,
  813. const struct omap_overlay_manager_info *info)
  814. {
  815. if (dss_has_feature(FEAT_ALPHA_FIXED_ZORDER)) {
  816. /*
  817. * OMAP3 supports only graphics source transparency color key
  818. * and alpha blending simultaneously. See TRM 15.4.2.4.2.2
  819. * Alpha Mode.
  820. */
  821. if (info->partial_alpha_enabled && info->trans_enabled
  822. && info->trans_key_type != OMAP_DSS_COLOR_KEY_GFX_DST) {
  823. DSSERR("check_manager: illegal transparency key\n");
  824. return -EINVAL;
  825. }
  826. }
  827. return 0;
  828. }
  829. int dss_mgr_set_info(struct omap_overlay_manager *mgr,
  830. struct omap_overlay_manager_info *info)
  831. {
  832. struct mgr_priv_data *mp = get_mgr_priv(mgr);
  833. unsigned long flags;
  834. int r;
  835. r = dss_mgr_simple_check(mgr, info);
  836. if (r)
  837. return r;
  838. spin_lock_irqsave(&data_lock, flags);
  839. mp->user_info = *info;
  840. mp->user_info_dirty = true;
  841. spin_unlock_irqrestore(&data_lock, flags);
  842. return 0;
  843. }
  844. void dss_mgr_get_info(struct omap_overlay_manager *mgr,
  845. struct omap_overlay_manager_info *info)
  846. {
  847. struct mgr_priv_data *mp = get_mgr_priv(mgr);
  848. unsigned long flags;
  849. spin_lock_irqsave(&data_lock, flags);
  850. *info = mp->user_info;
  851. spin_unlock_irqrestore(&data_lock, flags);
  852. }
  853. int dss_mgr_set_device(struct omap_overlay_manager *mgr,
  854. struct omap_dss_device *dssdev)
  855. {
  856. int r;
  857. mutex_lock(&apply_lock);
  858. if (dssdev->manager) {
  859. DSSERR("display '%s' already has a manager '%s'\n",
  860. dssdev->name, dssdev->manager->name);
  861. r = -EINVAL;
  862. goto err;
  863. }
  864. if ((mgr->supported_displays & dssdev->type) == 0) {
  865. DSSERR("display '%s' does not support manager '%s'\n",
  866. dssdev->name, mgr->name);
  867. r = -EINVAL;
  868. goto err;
  869. }
  870. dssdev->manager = mgr;
  871. mgr->device = dssdev;
  872. mutex_unlock(&apply_lock);
  873. return 0;
  874. err:
  875. mutex_unlock(&apply_lock);
  876. return r;
  877. }
  878. int dss_mgr_unset_device(struct omap_overlay_manager *mgr)
  879. {
  880. int r;
  881. mutex_lock(&apply_lock);
  882. if (!mgr->device) {
  883. DSSERR("failed to unset display, display not set.\n");
  884. r = -EINVAL;
  885. goto err;
  886. }
  887. /*
  888. * Don't allow currently enabled displays to have the overlay manager
  889. * pulled out from underneath them
  890. */
  891. if (mgr->device->state != OMAP_DSS_DISPLAY_DISABLED) {
  892. r = -EINVAL;
  893. goto err;
  894. }
  895. mgr->device->manager = NULL;
  896. mgr->device = NULL;
  897. mutex_unlock(&apply_lock);
  898. return 0;
  899. err:
  900. mutex_unlock(&apply_lock);
  901. return r;
  902. }
  903. static int dss_ovl_simple_check(struct omap_overlay *ovl,
  904. const struct omap_overlay_info *info)
  905. {
  906. if (info->paddr == 0) {
  907. DSSERR("check_overlay: paddr cannot be 0\n");
  908. return -EINVAL;
  909. }
  910. if ((ovl->caps & OMAP_DSS_OVL_CAP_SCALE) == 0) {
  911. if (info->out_width != 0 && info->width != info->out_width) {
  912. DSSERR("check_overlay: overlay %d doesn't support "
  913. "scaling\n", ovl->id);
  914. return -EINVAL;
  915. }
  916. if (info->out_height != 0 && info->height != info->out_height) {
  917. DSSERR("check_overlay: overlay %d doesn't support "
  918. "scaling\n", ovl->id);
  919. return -EINVAL;
  920. }
  921. }
  922. if ((ovl->supported_modes & info->color_mode) == 0) {
  923. DSSERR("check_overlay: overlay %d doesn't support mode %d\n",
  924. ovl->id, info->color_mode);
  925. return -EINVAL;
  926. }
  927. if (info->zorder >= omap_dss_get_num_overlays()) {
  928. DSSERR("check_overlay: zorder %d too high\n", info->zorder);
  929. return -EINVAL;
  930. }
  931. return 0;
  932. }
  933. int dss_ovl_set_info(struct omap_overlay *ovl,
  934. struct omap_overlay_info *info)
  935. {
  936. struct ovl_priv_data *op = get_ovl_priv(ovl);
  937. unsigned long flags;
  938. int r;
  939. r = dss_ovl_simple_check(ovl, info);
  940. if (r)
  941. return r;
  942. spin_lock_irqsave(&data_lock, flags);
  943. op->user_info = *info;
  944. op->user_info_dirty = true;
  945. spin_unlock_irqrestore(&data_lock, flags);
  946. return 0;
  947. }
  948. void dss_ovl_get_info(struct omap_overlay *ovl,
  949. struct omap_overlay_info *info)
  950. {
  951. struct ovl_priv_data *op = get_ovl_priv(ovl);
  952. unsigned long flags;
  953. spin_lock_irqsave(&data_lock, flags);
  954. *info = op->user_info;
  955. spin_unlock_irqrestore(&data_lock, flags);
  956. }
  957. int dss_ovl_set_manager(struct omap_overlay *ovl,
  958. struct omap_overlay_manager *mgr)
  959. {
  960. struct ovl_priv_data *op = get_ovl_priv(ovl);
  961. unsigned long flags;
  962. int r;
  963. if (!mgr)
  964. return -EINVAL;
  965. mutex_lock(&apply_lock);
  966. if (ovl->manager) {
  967. DSSERR("overlay '%s' already has a manager '%s'\n",
  968. ovl->name, ovl->manager->name);
  969. r = -EINVAL;
  970. goto err;
  971. }
  972. spin_lock_irqsave(&data_lock, flags);
  973. if (op->enabled) {
  974. spin_unlock_irqrestore(&data_lock, flags);
  975. DSSERR("overlay has to be disabled to change the manager\n");
  976. r = -EINVAL;
  977. goto err;
  978. }
  979. op->channel = mgr->id;
  980. op->extra_info_dirty = true;
  981. ovl->manager = mgr;
  982. list_add_tail(&ovl->list, &mgr->overlays);
  983. spin_unlock_irqrestore(&data_lock, flags);
  984. /* XXX: When there is an overlay on a DSI manual update display, and
  985. * the overlay is first disabled, then moved to tv, and enabled, we
  986. * seem to get SYNC_LOST_DIGIT error.
  987. *
  988. * Waiting doesn't seem to help, but updating the manual update display
  989. * after disabling the overlay seems to fix this. This hints that the
  990. * overlay is perhaps somehow tied to the LCD output until the output
  991. * is updated.
  992. *
  993. * Userspace workaround for this is to update the LCD after disabling
  994. * the overlay, but before moving the overlay to TV.
  995. */
  996. mutex_unlock(&apply_lock);
  997. return 0;
  998. err:
  999. mutex_unlock(&apply_lock);
  1000. return r;
  1001. }
  1002. int dss_ovl_unset_manager(struct omap_overlay *ovl)
  1003. {
  1004. struct ovl_priv_data *op = get_ovl_priv(ovl);
  1005. unsigned long flags;
  1006. int r;
  1007. mutex_lock(&apply_lock);
  1008. if (!ovl->manager) {
  1009. DSSERR("failed to detach overlay: manager not set\n");
  1010. r = -EINVAL;
  1011. goto err;
  1012. }
  1013. spin_lock_irqsave(&data_lock, flags);
  1014. if (op->enabled) {
  1015. spin_unlock_irqrestore(&data_lock, flags);
  1016. DSSERR("overlay has to be disabled to unset the manager\n");
  1017. r = -EINVAL;
  1018. goto err;
  1019. }
  1020. op->channel = -1;
  1021. ovl->manager = NULL;
  1022. list_del(&ovl->list);
  1023. spin_unlock_irqrestore(&data_lock, flags);
  1024. mutex_unlock(&apply_lock);
  1025. return 0;
  1026. err:
  1027. mutex_unlock(&apply_lock);
  1028. return r;
  1029. }
  1030. bool dss_ovl_is_enabled(struct omap_overlay *ovl)
  1031. {
  1032. struct ovl_priv_data *op = get_ovl_priv(ovl);
  1033. unsigned long flags;
  1034. bool e;
  1035. spin_lock_irqsave(&data_lock, flags);
  1036. e = op->enabled;
  1037. spin_unlock_irqrestore(&data_lock, flags);
  1038. return e;
  1039. }
  1040. int dss_ovl_enable(struct omap_overlay *ovl)
  1041. {
  1042. struct ovl_priv_data *op = get_ovl_priv(ovl);
  1043. unsigned long flags;
  1044. int r;
  1045. mutex_lock(&apply_lock);
  1046. if (op->enabled) {
  1047. r = 0;
  1048. goto err1;
  1049. }
  1050. if (ovl->manager == NULL || ovl->manager->device == NULL) {
  1051. r = -EINVAL;
  1052. goto err1;
  1053. }
  1054. spin_lock_irqsave(&data_lock, flags);
  1055. op->enabled = true;
  1056. r = dss_check_settings(ovl->manager, ovl->manager->device);
  1057. op->enabled = false;
  1058. if (r) {
  1059. DSSERR("failed to enable overlay %d: check_settings failed\n",
  1060. ovl->id);
  1061. goto err2;
  1062. }
  1063. dss_apply_ovl_enable(ovl, true);
  1064. dss_ovl_setup_fifo(ovl);
  1065. dss_write_regs();
  1066. spin_unlock_irqrestore(&data_lock, flags);
  1067. mutex_unlock(&apply_lock);
  1068. return 0;
  1069. err2:
  1070. spin_unlock_irqrestore(&data_lock, flags);
  1071. err1:
  1072. mutex_unlock(&apply_lock);
  1073. return r;
  1074. }
  1075. int dss_ovl_disable(struct omap_overlay *ovl)
  1076. {
  1077. struct ovl_priv_data *op = get_ovl_priv(ovl);
  1078. unsigned long flags;
  1079. int r;
  1080. mutex_lock(&apply_lock);
  1081. if (!op->enabled) {
  1082. r = 0;
  1083. goto err;
  1084. }
  1085. if (ovl->manager == NULL || ovl->manager->device == NULL) {
  1086. r = -EINVAL;
  1087. goto err;
  1088. }
  1089. spin_lock_irqsave(&data_lock, flags);
  1090. dss_apply_ovl_enable(ovl, false);
  1091. dss_write_regs();
  1092. spin_unlock_irqrestore(&data_lock, flags);
  1093. mutex_unlock(&apply_lock);
  1094. return 0;
  1095. err:
  1096. mutex_unlock(&apply_lock);
  1097. return r;
  1098. }