drm_irq.c 49 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691
  1. /*
  2. * drm_irq.c IRQ and vblank support
  3. *
  4. * \author Rickard E. (Rik) Faith <faith@valinux.com>
  5. * \author Gareth Hughes <gareth@valinux.com>
  6. */
  7. /*
  8. * Created: Fri Mar 19 14:30:16 1999 by faith@valinux.com
  9. *
  10. * Copyright 1999, 2000 Precision Insight, Inc., Cedar Park, Texas.
  11. * Copyright 2000 VA Linux Systems, Inc., Sunnyvale, California.
  12. * All Rights Reserved.
  13. *
  14. * Permission is hereby granted, free of charge, to any person obtaining a
  15. * copy of this software and associated documentation files (the "Software"),
  16. * to deal in the Software without restriction, including without limitation
  17. * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  18. * and/or sell copies of the Software, and to permit persons to whom the
  19. * Software is furnished to do so, subject to the following conditions:
  20. *
  21. * The above copyright notice and this permission notice (including the next
  22. * paragraph) shall be included in all copies or substantial portions of the
  23. * Software.
  24. *
  25. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  26. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  27. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  28. * VA LINUX SYSTEMS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
  29. * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  30. * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  31. * OTHER DEALINGS IN THE SOFTWARE.
  32. */
  33. #include <drm/drmP.h>
  34. #include "drm_trace.h"
  35. #include "drm_internal.h"
  36. #include <linux/interrupt.h> /* For task queue support */
  37. #include <linux/slab.h>
  38. #include <linux/vgaarb.h>
  39. #include <linux/export.h>
  40. /* Access macro for slots in vblank timestamp ringbuffer. */
  41. #define vblanktimestamp(dev, crtc, count) \
  42. ((dev)->vblank[crtc].time[(count) % DRM_VBLANKTIME_RBSIZE])
  43. /* Retry timestamp calculation up to 3 times to satisfy
  44. * drm_timestamp_precision before giving up.
  45. */
  46. #define DRM_TIMESTAMP_MAXRETRIES 3
  47. /* Threshold in nanoseconds for detection of redundant
  48. * vblank irq in drm_handle_vblank(). 1 msec should be ok.
  49. */
  50. #define DRM_REDUNDANT_VBLIRQ_THRESH_NS 1000000
  51. static bool
  52. drm_get_last_vbltimestamp(struct drm_device *dev, int crtc,
  53. struct timeval *tvblank, unsigned flags);
  54. static unsigned int drm_timestamp_precision = 20; /* Default to 20 usecs. */
  55. /*
  56. * Default to use monotonic timestamps for wait-for-vblank and page-flip
  57. * complete events.
  58. */
  59. unsigned int drm_timestamp_monotonic = 1;
  60. static int drm_vblank_offdelay = 5000; /* Default to 5000 msecs. */
  61. module_param_named(vblankoffdelay, drm_vblank_offdelay, int, 0600);
  62. module_param_named(timestamp_precision_usec, drm_timestamp_precision, int, 0600);
  63. module_param_named(timestamp_monotonic, drm_timestamp_monotonic, int, 0600);
  64. /**
  65. * drm_update_vblank_count - update the master vblank counter
  66. * @dev: DRM device
  67. * @crtc: counter to update
  68. *
  69. * Call back into the driver to update the appropriate vblank counter
  70. * (specified by @crtc). Deal with wraparound, if it occurred, and
  71. * update the last read value so we can deal with wraparound on the next
  72. * call if necessary.
  73. *
  74. * Only necessary when going from off->on, to account for frames we
  75. * didn't get an interrupt for.
  76. *
  77. * Note: caller must hold dev->vbl_lock since this reads & writes
  78. * device vblank fields.
  79. */
  80. static void drm_update_vblank_count(struct drm_device *dev, int crtc)
  81. {
  82. struct drm_vblank_crtc *vblank = &dev->vblank[crtc];
  83. u32 cur_vblank, diff, tslot;
  84. bool rc;
  85. struct timeval t_vblank;
  86. /*
  87. * Interrupts were disabled prior to this call, so deal with counter
  88. * wrap if needed.
  89. * NOTE! It's possible we lost a full dev->max_vblank_count events
  90. * here if the register is small or we had vblank interrupts off for
  91. * a long time.
  92. *
  93. * We repeat the hardware vblank counter & timestamp query until
  94. * we get consistent results. This to prevent races between gpu
  95. * updating its hardware counter while we are retrieving the
  96. * corresponding vblank timestamp.
  97. */
  98. do {
  99. cur_vblank = dev->driver->get_vblank_counter(dev, crtc);
  100. rc = drm_get_last_vbltimestamp(dev, crtc, &t_vblank, 0);
  101. } while (cur_vblank != dev->driver->get_vblank_counter(dev, crtc));
  102. /* Deal with counter wrap */
  103. diff = cur_vblank - vblank->last;
  104. if (cur_vblank < vblank->last) {
  105. diff += dev->max_vblank_count;
  106. DRM_DEBUG("last_vblank[%d]=0x%x, cur_vblank=0x%x => diff=0x%x\n",
  107. crtc, vblank->last, cur_vblank, diff);
  108. }
  109. DRM_DEBUG("updating vblank count on crtc %d, missed %d\n",
  110. crtc, diff);
  111. if (diff == 0)
  112. return;
  113. /* Reinitialize corresponding vblank timestamp if high-precision query
  114. * available. Skip this step if query unsupported or failed. Will
  115. * reinitialize delayed at next vblank interrupt in that case.
  116. */
  117. if (rc) {
  118. tslot = atomic_read(&vblank->count) + diff;
  119. vblanktimestamp(dev, crtc, tslot) = t_vblank;
  120. }
  121. smp_mb__before_atomic();
  122. atomic_add(diff, &vblank->count);
  123. smp_mb__after_atomic();
  124. }
  125. /*
  126. * Disable vblank irq's on crtc, make sure that last vblank count
  127. * of hardware and corresponding consistent software vblank counter
  128. * are preserved, even if there are any spurious vblank irq's after
  129. * disable.
  130. */
  131. static void vblank_disable_and_save(struct drm_device *dev, int crtc)
  132. {
  133. struct drm_vblank_crtc *vblank = &dev->vblank[crtc];
  134. unsigned long irqflags;
  135. u32 vblcount;
  136. s64 diff_ns;
  137. bool vblrc;
  138. struct timeval tvblank;
  139. int count = DRM_TIMESTAMP_MAXRETRIES;
  140. /* Prevent vblank irq processing while disabling vblank irqs,
  141. * so no updates of timestamps or count can happen after we've
  142. * disabled. Needed to prevent races in case of delayed irq's.
  143. */
  144. spin_lock_irqsave(&dev->vblank_time_lock, irqflags);
  145. /*
  146. * If the vblank interrupt was already disabled update the count
  147. * and timestamp to maintain the appearance that the counter
  148. * has been ticking all along until this time. This makes the
  149. * count account for the entire time between drm_vblank_on() and
  150. * drm_vblank_off().
  151. *
  152. * But only do this if precise vblank timestamps are available.
  153. * Otherwise we might read a totally bogus timestamp since drivers
  154. * lacking precise timestamp support rely upon sampling the system clock
  155. * at vblank interrupt time. Which obviously won't work out well if the
  156. * vblank interrupt is disabled.
  157. */
  158. if (!vblank->enabled &&
  159. drm_get_last_vbltimestamp(dev, crtc, &tvblank, 0)) {
  160. drm_update_vblank_count(dev, crtc);
  161. spin_unlock_irqrestore(&dev->vblank_time_lock, irqflags);
  162. return;
  163. }
  164. dev->driver->disable_vblank(dev, crtc);
  165. vblank->enabled = false;
  166. /* No further vblank irq's will be processed after
  167. * this point. Get current hardware vblank count and
  168. * vblank timestamp, repeat until they are consistent.
  169. *
  170. * FIXME: There is still a race condition here and in
  171. * drm_update_vblank_count() which can cause off-by-one
  172. * reinitialization of software vblank counter. If gpu
  173. * vblank counter doesn't increment exactly at the leading
  174. * edge of a vblank interval, then we can lose 1 count if
  175. * we happen to execute between start of vblank and the
  176. * delayed gpu counter increment.
  177. */
  178. do {
  179. vblank->last = dev->driver->get_vblank_counter(dev, crtc);
  180. vblrc = drm_get_last_vbltimestamp(dev, crtc, &tvblank, 0);
  181. } while (vblank->last != dev->driver->get_vblank_counter(dev, crtc) && (--count) && vblrc);
  182. if (!count)
  183. vblrc = 0;
  184. /* Compute time difference to stored timestamp of last vblank
  185. * as updated by last invocation of drm_handle_vblank() in vblank irq.
  186. */
  187. vblcount = atomic_read(&vblank->count);
  188. diff_ns = timeval_to_ns(&tvblank) -
  189. timeval_to_ns(&vblanktimestamp(dev, crtc, vblcount));
  190. /* If there is at least 1 msec difference between the last stored
  191. * timestamp and tvblank, then we are currently executing our
  192. * disable inside a new vblank interval, the tvblank timestamp
  193. * corresponds to this new vblank interval and the irq handler
  194. * for this vblank didn't run yet and won't run due to our disable.
  195. * Therefore we need to do the job of drm_handle_vblank() and
  196. * increment the vblank counter by one to account for this vblank.
  197. *
  198. * Skip this step if there isn't any high precision timestamp
  199. * available. In that case we can't account for this and just
  200. * hope for the best.
  201. */
  202. if (vblrc && (abs64(diff_ns) > 1000000)) {
  203. /* Store new timestamp in ringbuffer. */
  204. vblanktimestamp(dev, crtc, vblcount + 1) = tvblank;
  205. /* Increment cooked vblank count. This also atomically commits
  206. * the timestamp computed above.
  207. */
  208. smp_mb__before_atomic();
  209. atomic_inc(&vblank->count);
  210. smp_mb__after_atomic();
  211. }
  212. spin_unlock_irqrestore(&dev->vblank_time_lock, irqflags);
  213. }
  214. static void vblank_disable_fn(unsigned long arg)
  215. {
  216. struct drm_vblank_crtc *vblank = (void *)arg;
  217. struct drm_device *dev = vblank->dev;
  218. unsigned long irqflags;
  219. int crtc = vblank->crtc;
  220. if (!dev->vblank_disable_allowed)
  221. return;
  222. spin_lock_irqsave(&dev->vbl_lock, irqflags);
  223. if (atomic_read(&vblank->refcount) == 0 && vblank->enabled) {
  224. DRM_DEBUG("disabling vblank on crtc %d\n", crtc);
  225. vblank_disable_and_save(dev, crtc);
  226. }
  227. spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
  228. }
  229. /**
  230. * drm_vblank_cleanup - cleanup vblank support
  231. * @dev: DRM device
  232. *
  233. * This function cleans up any resources allocated in drm_vblank_init.
  234. */
  235. void drm_vblank_cleanup(struct drm_device *dev)
  236. {
  237. int crtc;
  238. unsigned long irqflags;
  239. /* Bail if the driver didn't call drm_vblank_init() */
  240. if (dev->num_crtcs == 0)
  241. return;
  242. for (crtc = 0; crtc < dev->num_crtcs; crtc++) {
  243. struct drm_vblank_crtc *vblank = &dev->vblank[crtc];
  244. del_timer_sync(&vblank->disable_timer);
  245. spin_lock_irqsave(&dev->vbl_lock, irqflags);
  246. vblank_disable_and_save(dev, crtc);
  247. spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
  248. }
  249. kfree(dev->vblank);
  250. dev->num_crtcs = 0;
  251. }
  252. EXPORT_SYMBOL(drm_vblank_cleanup);
  253. /**
  254. * drm_vblank_init - initialize vblank support
  255. * @dev: drm_device
  256. * @num_crtcs: number of crtcs supported by @dev
  257. *
  258. * This function initializes vblank support for @num_crtcs display pipelines.
  259. *
  260. * Returns:
  261. * Zero on success or a negative error code on failure.
  262. */
  263. int drm_vblank_init(struct drm_device *dev, int num_crtcs)
  264. {
  265. int i, ret = -ENOMEM;
  266. spin_lock_init(&dev->vbl_lock);
  267. spin_lock_init(&dev->vblank_time_lock);
  268. dev->num_crtcs = num_crtcs;
  269. dev->vblank = kcalloc(num_crtcs, sizeof(*dev->vblank), GFP_KERNEL);
  270. if (!dev->vblank)
  271. goto err;
  272. for (i = 0; i < num_crtcs; i++) {
  273. struct drm_vblank_crtc *vblank = &dev->vblank[i];
  274. vblank->dev = dev;
  275. vblank->crtc = i;
  276. init_waitqueue_head(&vblank->queue);
  277. setup_timer(&vblank->disable_timer, vblank_disable_fn,
  278. (unsigned long)vblank);
  279. }
  280. DRM_INFO("Supports vblank timestamp caching Rev 2 (21.10.2013).\n");
  281. /* Driver specific high-precision vblank timestamping supported? */
  282. if (dev->driver->get_vblank_timestamp)
  283. DRM_INFO("Driver supports precise vblank timestamp query.\n");
  284. else
  285. DRM_INFO("No driver support for vblank timestamp query.\n");
  286. dev->vblank_disable_allowed = false;
  287. return 0;
  288. err:
  289. dev->num_crtcs = 0;
  290. return ret;
  291. }
  292. EXPORT_SYMBOL(drm_vblank_init);
  293. static void drm_irq_vgaarb_nokms(void *cookie, bool state)
  294. {
  295. struct drm_device *dev = cookie;
  296. if (dev->driver->vgaarb_irq) {
  297. dev->driver->vgaarb_irq(dev, state);
  298. return;
  299. }
  300. if (!dev->irq_enabled)
  301. return;
  302. if (state) {
  303. if (dev->driver->irq_uninstall)
  304. dev->driver->irq_uninstall(dev);
  305. } else {
  306. if (dev->driver->irq_preinstall)
  307. dev->driver->irq_preinstall(dev);
  308. if (dev->driver->irq_postinstall)
  309. dev->driver->irq_postinstall(dev);
  310. }
  311. }
  312. /**
  313. * drm_irq_install - install IRQ handler
  314. * @dev: DRM device
  315. * @irq: IRQ number to install the handler for
  316. *
  317. * Initializes the IRQ related data. Installs the handler, calling the driver
  318. * irq_preinstall() and irq_postinstall() functions before and after the
  319. * installation.
  320. *
  321. * This is the simplified helper interface provided for drivers with no special
  322. * needs. Drivers which need to install interrupt handlers for multiple
  323. * interrupts must instead set drm_device->irq_enabled to signal the DRM core
  324. * that vblank interrupts are available.
  325. *
  326. * Returns:
  327. * Zero on success or a negative error code on failure.
  328. */
  329. int drm_irq_install(struct drm_device *dev, int irq)
  330. {
  331. int ret;
  332. unsigned long sh_flags = 0;
  333. if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
  334. return -EINVAL;
  335. if (irq == 0)
  336. return -EINVAL;
  337. /* Driver must have been initialized */
  338. if (!dev->dev_private)
  339. return -EINVAL;
  340. if (dev->irq_enabled)
  341. return -EBUSY;
  342. dev->irq_enabled = true;
  343. DRM_DEBUG("irq=%d\n", irq);
  344. /* Before installing handler */
  345. if (dev->driver->irq_preinstall)
  346. dev->driver->irq_preinstall(dev);
  347. /* Install handler */
  348. if (drm_core_check_feature(dev, DRIVER_IRQ_SHARED))
  349. sh_flags = IRQF_SHARED;
  350. ret = request_irq(irq, dev->driver->irq_handler,
  351. sh_flags, dev->driver->name, dev);
  352. if (ret < 0) {
  353. dev->irq_enabled = false;
  354. return ret;
  355. }
  356. if (!drm_core_check_feature(dev, DRIVER_MODESET))
  357. vga_client_register(dev->pdev, (void *)dev, drm_irq_vgaarb_nokms, NULL);
  358. /* After installing handler */
  359. if (dev->driver->irq_postinstall)
  360. ret = dev->driver->irq_postinstall(dev);
  361. if (ret < 0) {
  362. dev->irq_enabled = false;
  363. if (!drm_core_check_feature(dev, DRIVER_MODESET))
  364. vga_client_register(dev->pdev, NULL, NULL, NULL);
  365. free_irq(irq, dev);
  366. } else {
  367. dev->irq = irq;
  368. }
  369. return ret;
  370. }
  371. EXPORT_SYMBOL(drm_irq_install);
  372. /**
  373. * drm_irq_uninstall - uninstall the IRQ handler
  374. * @dev: DRM device
  375. *
  376. * Calls the driver's irq_uninstall() function and unregisters the IRQ handler.
  377. * This should only be called by drivers which used drm_irq_install() to set up
  378. * their interrupt handler. Other drivers must only reset
  379. * drm_device->irq_enabled to false.
  380. *
  381. * Note that for kernel modesetting drivers it is a bug if this function fails.
  382. * The sanity checks are only to catch buggy user modesetting drivers which call
  383. * the same function through an ioctl.
  384. *
  385. * Returns:
  386. * Zero on success or a negative error code on failure.
  387. */
  388. int drm_irq_uninstall(struct drm_device *dev)
  389. {
  390. unsigned long irqflags;
  391. bool irq_enabled;
  392. int i;
  393. if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
  394. return -EINVAL;
  395. irq_enabled = dev->irq_enabled;
  396. dev->irq_enabled = false;
  397. /*
  398. * Wake up any waiters so they don't hang.
  399. */
  400. if (dev->num_crtcs) {
  401. spin_lock_irqsave(&dev->vbl_lock, irqflags);
  402. for (i = 0; i < dev->num_crtcs; i++) {
  403. struct drm_vblank_crtc *vblank = &dev->vblank[i];
  404. wake_up(&vblank->queue);
  405. vblank->enabled = false;
  406. vblank->last =
  407. dev->driver->get_vblank_counter(dev, i);
  408. }
  409. spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
  410. }
  411. if (!irq_enabled)
  412. return -EINVAL;
  413. DRM_DEBUG("irq=%d\n", dev->irq);
  414. if (!drm_core_check_feature(dev, DRIVER_MODESET))
  415. vga_client_register(dev->pdev, NULL, NULL, NULL);
  416. if (dev->driver->irq_uninstall)
  417. dev->driver->irq_uninstall(dev);
  418. free_irq(dev->irq, dev);
  419. return 0;
  420. }
  421. EXPORT_SYMBOL(drm_irq_uninstall);
  422. /*
  423. * IRQ control ioctl.
  424. *
  425. * \param inode device inode.
  426. * \param file_priv DRM file private.
  427. * \param cmd command.
  428. * \param arg user argument, pointing to a drm_control structure.
  429. * \return zero on success or a negative number on failure.
  430. *
  431. * Calls irq_install() or irq_uninstall() according to \p arg.
  432. */
  433. int drm_control(struct drm_device *dev, void *data,
  434. struct drm_file *file_priv)
  435. {
  436. struct drm_control *ctl = data;
  437. int ret = 0, irq;
  438. /* if we haven't irq we fallback for compatibility reasons -
  439. * this used to be a separate function in drm_dma.h
  440. */
  441. if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
  442. return 0;
  443. if (drm_core_check_feature(dev, DRIVER_MODESET))
  444. return 0;
  445. /* UMS was only ever support on pci devices. */
  446. if (WARN_ON(!dev->pdev))
  447. return -EINVAL;
  448. switch (ctl->func) {
  449. case DRM_INST_HANDLER:
  450. irq = dev->pdev->irq;
  451. if (dev->if_version < DRM_IF_VERSION(1, 2) &&
  452. ctl->irq != irq)
  453. return -EINVAL;
  454. mutex_lock(&dev->struct_mutex);
  455. ret = drm_irq_install(dev, irq);
  456. mutex_unlock(&dev->struct_mutex);
  457. return ret;
  458. case DRM_UNINST_HANDLER:
  459. mutex_lock(&dev->struct_mutex);
  460. ret = drm_irq_uninstall(dev);
  461. mutex_unlock(&dev->struct_mutex);
  462. return ret;
  463. default:
  464. return -EINVAL;
  465. }
  466. }
  467. /**
  468. * drm_calc_timestamping_constants - calculate vblank timestamp constants
  469. * @crtc: drm_crtc whose timestamp constants should be updated.
  470. * @mode: display mode containing the scanout timings
  471. *
  472. * Calculate and store various constants which are later
  473. * needed by vblank and swap-completion timestamping, e.g,
  474. * by drm_calc_vbltimestamp_from_scanoutpos(). They are
  475. * derived from CRTC's true scanout timing, so they take
  476. * things like panel scaling or other adjustments into account.
  477. */
  478. void drm_calc_timestamping_constants(struct drm_crtc *crtc,
  479. const struct drm_display_mode *mode)
  480. {
  481. int linedur_ns = 0, pixeldur_ns = 0, framedur_ns = 0;
  482. int dotclock = mode->crtc_clock;
  483. /* Valid dotclock? */
  484. if (dotclock > 0) {
  485. int frame_size = mode->crtc_htotal * mode->crtc_vtotal;
  486. /*
  487. * Convert scanline length in pixels and video
  488. * dot clock to line duration, frame duration
  489. * and pixel duration in nanoseconds:
  490. */
  491. pixeldur_ns = 1000000 / dotclock;
  492. linedur_ns = div_u64((u64) mode->crtc_htotal * 1000000, dotclock);
  493. framedur_ns = div_u64((u64) frame_size * 1000000, dotclock);
  494. /*
  495. * Fields of interlaced scanout modes are only half a frame duration.
  496. */
  497. if (mode->flags & DRM_MODE_FLAG_INTERLACE)
  498. framedur_ns /= 2;
  499. } else
  500. DRM_ERROR("crtc %d: Can't calculate constants, dotclock = 0!\n",
  501. crtc->base.id);
  502. crtc->pixeldur_ns = pixeldur_ns;
  503. crtc->linedur_ns = linedur_ns;
  504. crtc->framedur_ns = framedur_ns;
  505. DRM_DEBUG("crtc %d: hwmode: htotal %d, vtotal %d, vdisplay %d\n",
  506. crtc->base.id, mode->crtc_htotal,
  507. mode->crtc_vtotal, mode->crtc_vdisplay);
  508. DRM_DEBUG("crtc %d: clock %d kHz framedur %d linedur %d, pixeldur %d\n",
  509. crtc->base.id, dotclock, framedur_ns,
  510. linedur_ns, pixeldur_ns);
  511. }
  512. EXPORT_SYMBOL(drm_calc_timestamping_constants);
  513. /**
  514. * drm_calc_vbltimestamp_from_scanoutpos - precise vblank timestamp helper
  515. * @dev: DRM device
  516. * @crtc: Which CRTC's vblank timestamp to retrieve
  517. * @max_error: Desired maximum allowable error in timestamps (nanosecs)
  518. * On return contains true maximum error of timestamp
  519. * @vblank_time: Pointer to struct timeval which should receive the timestamp
  520. * @flags: Flags to pass to driver:
  521. * 0 = Default,
  522. * DRM_CALLED_FROM_VBLIRQ = If function is called from vbl IRQ handler
  523. * @refcrtc: CRTC which defines scanout timing
  524. * @mode: mode which defines the scanout timings
  525. *
  526. * Implements calculation of exact vblank timestamps from given drm_display_mode
  527. * timings and current video scanout position of a CRTC. This can be called from
  528. * within get_vblank_timestamp() implementation of a kms driver to implement the
  529. * actual timestamping.
  530. *
  531. * Should return timestamps conforming to the OML_sync_control OpenML
  532. * extension specification. The timestamp corresponds to the end of
  533. * the vblank interval, aka start of scanout of topmost-leftmost display
  534. * pixel in the following video frame.
  535. *
  536. * Requires support for optional dev->driver->get_scanout_position()
  537. * in kms driver, plus a bit of setup code to provide a drm_display_mode
  538. * that corresponds to the true scanout timing.
  539. *
  540. * The current implementation only handles standard video modes. It
  541. * returns as no operation if a doublescan or interlaced video mode is
  542. * active. Higher level code is expected to handle this.
  543. *
  544. * Returns:
  545. * Negative value on error, failure or if not supported in current
  546. * video mode:
  547. *
  548. * -EINVAL - Invalid CRTC.
  549. * -EAGAIN - Temporary unavailable, e.g., called before initial modeset.
  550. * -ENOTSUPP - Function not supported in current display mode.
  551. * -EIO - Failed, e.g., due to failed scanout position query.
  552. *
  553. * Returns or'ed positive status flags on success:
  554. *
  555. * DRM_VBLANKTIME_SCANOUTPOS_METHOD - Signal this method used for timestamping.
  556. * DRM_VBLANKTIME_INVBL - Timestamp taken while scanout was in vblank interval.
  557. *
  558. */
  559. int drm_calc_vbltimestamp_from_scanoutpos(struct drm_device *dev, int crtc,
  560. int *max_error,
  561. struct timeval *vblank_time,
  562. unsigned flags,
  563. const struct drm_crtc *refcrtc,
  564. const struct drm_display_mode *mode)
  565. {
  566. struct timeval tv_etime;
  567. ktime_t stime, etime;
  568. int vbl_status;
  569. int vpos, hpos, i;
  570. int framedur_ns, linedur_ns, pixeldur_ns, delta_ns, duration_ns;
  571. bool invbl;
  572. if (crtc < 0 || crtc >= dev->num_crtcs) {
  573. DRM_ERROR("Invalid crtc %d\n", crtc);
  574. return -EINVAL;
  575. }
  576. /* Scanout position query not supported? Should not happen. */
  577. if (!dev->driver->get_scanout_position) {
  578. DRM_ERROR("Called from driver w/o get_scanout_position()!?\n");
  579. return -EIO;
  580. }
  581. /* Durations of frames, lines, pixels in nanoseconds. */
  582. framedur_ns = refcrtc->framedur_ns;
  583. linedur_ns = refcrtc->linedur_ns;
  584. pixeldur_ns = refcrtc->pixeldur_ns;
  585. /* If mode timing undefined, just return as no-op:
  586. * Happens during initial modesetting of a crtc.
  587. */
  588. if (framedur_ns == 0) {
  589. DRM_DEBUG("crtc %d: Noop due to uninitialized mode.\n", crtc);
  590. return -EAGAIN;
  591. }
  592. /* Get current scanout position with system timestamp.
  593. * Repeat query up to DRM_TIMESTAMP_MAXRETRIES times
  594. * if single query takes longer than max_error nanoseconds.
  595. *
  596. * This guarantees a tight bound on maximum error if
  597. * code gets preempted or delayed for some reason.
  598. */
  599. for (i = 0; i < DRM_TIMESTAMP_MAXRETRIES; i++) {
  600. /*
  601. * Get vertical and horizontal scanout position vpos, hpos,
  602. * and bounding timestamps stime, etime, pre/post query.
  603. */
  604. vbl_status = dev->driver->get_scanout_position(dev, crtc, flags, &vpos,
  605. &hpos, &stime, &etime);
  606. /* Return as no-op if scanout query unsupported or failed. */
  607. if (!(vbl_status & DRM_SCANOUTPOS_VALID)) {
  608. DRM_DEBUG("crtc %d : scanoutpos query failed [%d].\n",
  609. crtc, vbl_status);
  610. return -EIO;
  611. }
  612. /* Compute uncertainty in timestamp of scanout position query. */
  613. duration_ns = ktime_to_ns(etime) - ktime_to_ns(stime);
  614. /* Accept result with < max_error nsecs timing uncertainty. */
  615. if (duration_ns <= *max_error)
  616. break;
  617. }
  618. /* Noisy system timing? */
  619. if (i == DRM_TIMESTAMP_MAXRETRIES) {
  620. DRM_DEBUG("crtc %d: Noisy timestamp %d us > %d us [%d reps].\n",
  621. crtc, duration_ns/1000, *max_error/1000, i);
  622. }
  623. /* Return upper bound of timestamp precision error. */
  624. *max_error = duration_ns;
  625. /* Check if in vblank area:
  626. * vpos is >=0 in video scanout area, but negative
  627. * within vblank area, counting down the number of lines until
  628. * start of scanout.
  629. */
  630. invbl = vbl_status & DRM_SCANOUTPOS_IN_VBLANK;
  631. /* Convert scanout position into elapsed time at raw_time query
  632. * since start of scanout at first display scanline. delta_ns
  633. * can be negative if start of scanout hasn't happened yet.
  634. */
  635. delta_ns = vpos * linedur_ns + hpos * pixeldur_ns;
  636. if (!drm_timestamp_monotonic)
  637. etime = ktime_mono_to_real(etime);
  638. /* save this only for debugging purposes */
  639. tv_etime = ktime_to_timeval(etime);
  640. /* Subtract time delta from raw timestamp to get final
  641. * vblank_time timestamp for end of vblank.
  642. */
  643. if (delta_ns < 0)
  644. etime = ktime_add_ns(etime, -delta_ns);
  645. else
  646. etime = ktime_sub_ns(etime, delta_ns);
  647. *vblank_time = ktime_to_timeval(etime);
  648. DRM_DEBUG("crtc %d : v %d p(%d,%d)@ %ld.%ld -> %ld.%ld [e %d us, %d rep]\n",
  649. crtc, (int)vbl_status, hpos, vpos,
  650. (long)tv_etime.tv_sec, (long)tv_etime.tv_usec,
  651. (long)vblank_time->tv_sec, (long)vblank_time->tv_usec,
  652. duration_ns/1000, i);
  653. vbl_status = DRM_VBLANKTIME_SCANOUTPOS_METHOD;
  654. if (invbl)
  655. vbl_status |= DRM_VBLANKTIME_IN_VBLANK;
  656. return vbl_status;
  657. }
  658. EXPORT_SYMBOL(drm_calc_vbltimestamp_from_scanoutpos);
  659. static struct timeval get_drm_timestamp(void)
  660. {
  661. ktime_t now;
  662. now = drm_timestamp_monotonic ? ktime_get() : ktime_get_real();
  663. return ktime_to_timeval(now);
  664. }
  665. /**
  666. * drm_get_last_vbltimestamp - retrieve raw timestamp for the most recent
  667. * vblank interval
  668. * @dev: DRM device
  669. * @crtc: which CRTC's vblank timestamp to retrieve
  670. * @tvblank: Pointer to target struct timeval which should receive the timestamp
  671. * @flags: Flags to pass to driver:
  672. * 0 = Default,
  673. * DRM_CALLED_FROM_VBLIRQ = If function is called from vbl IRQ handler
  674. *
  675. * Fetches the system timestamp corresponding to the time of the most recent
  676. * vblank interval on specified CRTC. May call into kms-driver to
  677. * compute the timestamp with a high-precision GPU specific method.
  678. *
  679. * Returns zero if timestamp originates from uncorrected do_gettimeofday()
  680. * call, i.e., it isn't very precisely locked to the true vblank.
  681. *
  682. * Returns:
  683. * True if timestamp is considered to be very precise, false otherwise.
  684. */
  685. static bool
  686. drm_get_last_vbltimestamp(struct drm_device *dev, int crtc,
  687. struct timeval *tvblank, unsigned flags)
  688. {
  689. int ret;
  690. /* Define requested maximum error on timestamps (nanoseconds). */
  691. int max_error = (int) drm_timestamp_precision * 1000;
  692. /* Query driver if possible and precision timestamping enabled. */
  693. if (dev->driver->get_vblank_timestamp && (max_error > 0)) {
  694. ret = dev->driver->get_vblank_timestamp(dev, crtc, &max_error,
  695. tvblank, flags);
  696. if (ret > 0)
  697. return true;
  698. }
  699. /* GPU high precision timestamp query unsupported or failed.
  700. * Return current monotonic/gettimeofday timestamp as best estimate.
  701. */
  702. *tvblank = get_drm_timestamp();
  703. return false;
  704. }
  705. /**
  706. * drm_vblank_count - retrieve "cooked" vblank counter value
  707. * @dev: DRM device
  708. * @crtc: which counter to retrieve
  709. *
  710. * Fetches the "cooked" vblank count value that represents the number of
  711. * vblank events since the system was booted, including lost events due to
  712. * modesetting activity.
  713. *
  714. * Returns:
  715. * The software vblank counter.
  716. */
  717. u32 drm_vblank_count(struct drm_device *dev, int crtc)
  718. {
  719. struct drm_vblank_crtc *vblank = &dev->vblank[crtc];
  720. if (WARN_ON(crtc >= dev->num_crtcs))
  721. return 0;
  722. return atomic_read(&vblank->count);
  723. }
  724. EXPORT_SYMBOL(drm_vblank_count);
  725. /**
  726. * drm_vblank_count_and_time - retrieve "cooked" vblank counter value
  727. * and the system timestamp corresponding to that vblank counter value.
  728. *
  729. * @dev: DRM device
  730. * @crtc: which counter to retrieve
  731. * @vblanktime: Pointer to struct timeval to receive the vblank timestamp.
  732. *
  733. * Fetches the "cooked" vblank count value that represents the number of
  734. * vblank events since the system was booted, including lost events due to
  735. * modesetting activity. Returns corresponding system timestamp of the time
  736. * of the vblank interval that corresponds to the current vblank counter value.
  737. */
  738. u32 drm_vblank_count_and_time(struct drm_device *dev, int crtc,
  739. struct timeval *vblanktime)
  740. {
  741. struct drm_vblank_crtc *vblank = &dev->vblank[crtc];
  742. u32 cur_vblank;
  743. if (WARN_ON(crtc >= dev->num_crtcs))
  744. return 0;
  745. /* Read timestamp from slot of _vblank_time ringbuffer
  746. * that corresponds to current vblank count. Retry if
  747. * count has incremented during readout. This works like
  748. * a seqlock.
  749. */
  750. do {
  751. cur_vblank = atomic_read(&vblank->count);
  752. *vblanktime = vblanktimestamp(dev, crtc, cur_vblank);
  753. smp_rmb();
  754. } while (cur_vblank != atomic_read(&vblank->count));
  755. return cur_vblank;
  756. }
  757. EXPORT_SYMBOL(drm_vblank_count_and_time);
  758. static void send_vblank_event(struct drm_device *dev,
  759. struct drm_pending_vblank_event *e,
  760. unsigned long seq, struct timeval *now)
  761. {
  762. WARN_ON_SMP(!spin_is_locked(&dev->event_lock));
  763. e->event.sequence = seq;
  764. e->event.tv_sec = now->tv_sec;
  765. e->event.tv_usec = now->tv_usec;
  766. list_add_tail(&e->base.link,
  767. &e->base.file_priv->event_list);
  768. wake_up_interruptible(&e->base.file_priv->event_wait);
  769. trace_drm_vblank_event_delivered(e->base.pid, e->pipe,
  770. e->event.sequence);
  771. }
  772. /**
  773. * drm_send_vblank_event - helper to send vblank event after pageflip
  774. * @dev: DRM device
  775. * @crtc: CRTC in question
  776. * @e: the event to send
  777. *
  778. * Updates sequence # and timestamp on event, and sends it to userspace.
  779. * Caller must hold event lock.
  780. *
  781. * This is the legacy version of drm_crtc_send_vblank_event().
  782. */
  783. void drm_send_vblank_event(struct drm_device *dev, int crtc,
  784. struct drm_pending_vblank_event *e)
  785. {
  786. struct timeval now;
  787. unsigned int seq;
  788. if (crtc >= 0) {
  789. seq = drm_vblank_count_and_time(dev, crtc, &now);
  790. } else {
  791. seq = 0;
  792. now = get_drm_timestamp();
  793. }
  794. e->pipe = crtc;
  795. send_vblank_event(dev, e, seq, &now);
  796. }
  797. EXPORT_SYMBOL(drm_send_vblank_event);
  798. /**
  799. * drm_crtc_send_vblank_event - helper to send vblank event after pageflip
  800. * @crtc: the source CRTC of the vblank event
  801. * @e: the event to send
  802. *
  803. * Updates sequence # and timestamp on event, and sends it to userspace.
  804. * Caller must hold event lock.
  805. *
  806. * This is the native KMS version of drm_send_vblank_event().
  807. */
  808. void drm_crtc_send_vblank_event(struct drm_crtc *crtc,
  809. struct drm_pending_vblank_event *e)
  810. {
  811. drm_send_vblank_event(crtc->dev, drm_crtc_index(crtc), e);
  812. }
  813. EXPORT_SYMBOL(drm_crtc_send_vblank_event);
  814. /**
  815. * drm_vblank_enable - enable the vblank interrupt on a CRTC
  816. * @dev: DRM device
  817. * @crtc: CRTC in question
  818. */
  819. static int drm_vblank_enable(struct drm_device *dev, int crtc)
  820. {
  821. struct drm_vblank_crtc *vblank = &dev->vblank[crtc];
  822. int ret = 0;
  823. assert_spin_locked(&dev->vbl_lock);
  824. spin_lock(&dev->vblank_time_lock);
  825. if (!vblank->enabled) {
  826. /*
  827. * Enable vblank irqs under vblank_time_lock protection.
  828. * All vblank count & timestamp updates are held off
  829. * until we are done reinitializing master counter and
  830. * timestamps. Filtercode in drm_handle_vblank() will
  831. * prevent double-accounting of same vblank interval.
  832. */
  833. ret = dev->driver->enable_vblank(dev, crtc);
  834. DRM_DEBUG("enabling vblank on crtc %d, ret: %d\n", crtc, ret);
  835. if (ret)
  836. atomic_dec(&vblank->refcount);
  837. else {
  838. vblank->enabled = true;
  839. drm_update_vblank_count(dev, crtc);
  840. }
  841. }
  842. spin_unlock(&dev->vblank_time_lock);
  843. return ret;
  844. }
  845. /**
  846. * drm_vblank_get - get a reference count on vblank events
  847. * @dev: DRM device
  848. * @crtc: which CRTC to own
  849. *
  850. * Acquire a reference count on vblank events to avoid having them disabled
  851. * while in use.
  852. *
  853. * This is the legacy version of drm_crtc_vblank_get().
  854. *
  855. * Returns:
  856. * Zero on success, nonzero on failure.
  857. */
  858. int drm_vblank_get(struct drm_device *dev, int crtc)
  859. {
  860. struct drm_vblank_crtc *vblank = &dev->vblank[crtc];
  861. unsigned long irqflags;
  862. int ret = 0;
  863. if (WARN_ON(crtc >= dev->num_crtcs))
  864. return -EINVAL;
  865. spin_lock_irqsave(&dev->vbl_lock, irqflags);
  866. /* Going from 0->1 means we have to enable interrupts again */
  867. if (atomic_add_return(1, &vblank->refcount) == 1) {
  868. ret = drm_vblank_enable(dev, crtc);
  869. } else {
  870. if (!vblank->enabled) {
  871. atomic_dec(&vblank->refcount);
  872. ret = -EINVAL;
  873. }
  874. }
  875. spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
  876. return ret;
  877. }
  878. EXPORT_SYMBOL(drm_vblank_get);
  879. /**
  880. * drm_crtc_vblank_get - get a reference count on vblank events
  881. * @crtc: which CRTC to own
  882. *
  883. * Acquire a reference count on vblank events to avoid having them disabled
  884. * while in use.
  885. *
  886. * This is the native kms version of drm_vblank_off().
  887. *
  888. * Returns:
  889. * Zero on success, nonzero on failure.
  890. */
  891. int drm_crtc_vblank_get(struct drm_crtc *crtc)
  892. {
  893. return drm_vblank_get(crtc->dev, drm_crtc_index(crtc));
  894. }
  895. EXPORT_SYMBOL(drm_crtc_vblank_get);
  896. /**
  897. * drm_vblank_put - give up ownership of vblank events
  898. * @dev: DRM device
  899. * @crtc: which counter to give up
  900. *
  901. * Release ownership of a given vblank counter, turning off interrupts
  902. * if possible. Disable interrupts after drm_vblank_offdelay milliseconds.
  903. *
  904. * This is the legacy version of drm_crtc_vblank_put().
  905. */
  906. void drm_vblank_put(struct drm_device *dev, int crtc)
  907. {
  908. struct drm_vblank_crtc *vblank = &dev->vblank[crtc];
  909. if (WARN_ON(atomic_read(&vblank->refcount) == 0))
  910. return;
  911. if (WARN_ON(crtc >= dev->num_crtcs))
  912. return;
  913. /* Last user schedules interrupt disable */
  914. if (atomic_dec_and_test(&vblank->refcount)) {
  915. if (drm_vblank_offdelay == 0)
  916. return;
  917. else if (dev->vblank_disable_immediate || drm_vblank_offdelay < 0)
  918. vblank_disable_fn((unsigned long)vblank);
  919. else
  920. mod_timer(&vblank->disable_timer,
  921. jiffies + ((drm_vblank_offdelay * HZ)/1000));
  922. }
  923. }
  924. EXPORT_SYMBOL(drm_vblank_put);
  925. /**
  926. * drm_crtc_vblank_put - give up ownership of vblank events
  927. * @crtc: which counter to give up
  928. *
  929. * Release ownership of a given vblank counter, turning off interrupts
  930. * if possible. Disable interrupts after drm_vblank_offdelay milliseconds.
  931. *
  932. * This is the native kms version of drm_vblank_put().
  933. */
  934. void drm_crtc_vblank_put(struct drm_crtc *crtc)
  935. {
  936. drm_vblank_put(crtc->dev, drm_crtc_index(crtc));
  937. }
  938. EXPORT_SYMBOL(drm_crtc_vblank_put);
  939. /**
  940. * drm_wait_one_vblank - wait for one vblank
  941. * @dev: DRM device
  942. * @crtc: crtc index
  943. *
  944. * This waits for one vblank to pass on @crtc, using the irq driver interfaces.
  945. * It is a failure to call this when the vblank irq for @crtc is disabled, e.g.
  946. * due to lack of driver support or because the crtc is off.
  947. */
  948. void drm_wait_one_vblank(struct drm_device *dev, int crtc)
  949. {
  950. int ret;
  951. u32 last;
  952. ret = drm_vblank_get(dev, crtc);
  953. if (WARN(ret, "vblank not available on crtc %i, ret=%i\n", crtc, ret))
  954. return;
  955. last = drm_vblank_count(dev, crtc);
  956. ret = wait_event_timeout(dev->vblank[crtc].queue,
  957. last != drm_vblank_count(dev, crtc),
  958. msecs_to_jiffies(100));
  959. WARN(ret == 0, "vblank wait timed out on crtc %i\n", crtc);
  960. drm_vblank_put(dev, crtc);
  961. }
  962. EXPORT_SYMBOL(drm_wait_one_vblank);
  963. /**
  964. * drm_crtc_wait_one_vblank - wait for one vblank
  965. * @crtc: DRM crtc
  966. *
  967. * This waits for one vblank to pass on @crtc, using the irq driver interfaces.
  968. * It is a failure to call this when the vblank irq for @crtc is disabled, e.g.
  969. * due to lack of driver support or because the crtc is off.
  970. */
  971. void drm_crtc_wait_one_vblank(struct drm_crtc *crtc)
  972. {
  973. drm_wait_one_vblank(crtc->dev, drm_crtc_index(crtc));
  974. }
  975. EXPORT_SYMBOL(drm_crtc_wait_one_vblank);
  976. /**
  977. * drm_vblank_off - disable vblank events on a CRTC
  978. * @dev: DRM device
  979. * @crtc: CRTC in question
  980. *
  981. * Drivers can use this function to shut down the vblank interrupt handling when
  982. * disabling a crtc. This function ensures that the latest vblank frame count is
  983. * stored so that drm_vblank_on() can restore it again.
  984. *
  985. * Drivers must use this function when the hardware vblank counter can get
  986. * reset, e.g. when suspending.
  987. *
  988. * This is the legacy version of drm_crtc_vblank_off().
  989. */
  990. void drm_vblank_off(struct drm_device *dev, int crtc)
  991. {
  992. struct drm_vblank_crtc *vblank = &dev->vblank[crtc];
  993. struct drm_pending_vblank_event *e, *t;
  994. struct timeval now;
  995. unsigned long irqflags;
  996. unsigned int seq;
  997. if (WARN_ON(crtc >= dev->num_crtcs))
  998. return;
  999. spin_lock_irqsave(&dev->event_lock, irqflags);
  1000. spin_lock(&dev->vbl_lock);
  1001. vblank_disable_and_save(dev, crtc);
  1002. wake_up(&vblank->queue);
  1003. /*
  1004. * Prevent subsequent drm_vblank_get() from re-enabling
  1005. * the vblank interrupt by bumping the refcount.
  1006. */
  1007. if (!vblank->inmodeset) {
  1008. atomic_inc(&vblank->refcount);
  1009. vblank->inmodeset = 1;
  1010. }
  1011. spin_unlock(&dev->vbl_lock);
  1012. /* Send any queued vblank events, lest the natives grow disquiet */
  1013. seq = drm_vblank_count_and_time(dev, crtc, &now);
  1014. list_for_each_entry_safe(e, t, &dev->vblank_event_list, base.link) {
  1015. if (e->pipe != crtc)
  1016. continue;
  1017. DRM_DEBUG("Sending premature vblank event on disable: \
  1018. wanted %d, current %d\n",
  1019. e->event.sequence, seq);
  1020. list_del(&e->base.link);
  1021. drm_vblank_put(dev, e->pipe);
  1022. send_vblank_event(dev, e, seq, &now);
  1023. }
  1024. spin_unlock_irqrestore(&dev->event_lock, irqflags);
  1025. }
  1026. EXPORT_SYMBOL(drm_vblank_off);
  1027. /**
  1028. * drm_crtc_vblank_off - disable vblank events on a CRTC
  1029. * @crtc: CRTC in question
  1030. *
  1031. * Drivers can use this function to shut down the vblank interrupt handling when
  1032. * disabling a crtc. This function ensures that the latest vblank frame count is
  1033. * stored so that drm_vblank_on can restore it again.
  1034. *
  1035. * Drivers must use this function when the hardware vblank counter can get
  1036. * reset, e.g. when suspending.
  1037. *
  1038. * This is the native kms version of drm_vblank_off().
  1039. */
  1040. void drm_crtc_vblank_off(struct drm_crtc *crtc)
  1041. {
  1042. drm_vblank_off(crtc->dev, drm_crtc_index(crtc));
  1043. }
  1044. EXPORT_SYMBOL(drm_crtc_vblank_off);
  1045. /**
  1046. * drm_vblank_on - enable vblank events on a CRTC
  1047. * @dev: DRM device
  1048. * @crtc: CRTC in question
  1049. *
  1050. * This functions restores the vblank interrupt state captured with
  1051. * drm_vblank_off() again. Note that calls to drm_vblank_on() and
  1052. * drm_vblank_off() can be unbalanced and so can also be unconditionally called
  1053. * in driver load code to reflect the current hardware state of the crtc.
  1054. *
  1055. * This is the legacy version of drm_crtc_vblank_on().
  1056. */
  1057. void drm_vblank_on(struct drm_device *dev, int crtc)
  1058. {
  1059. struct drm_vblank_crtc *vblank = &dev->vblank[crtc];
  1060. unsigned long irqflags;
  1061. if (WARN_ON(crtc >= dev->num_crtcs))
  1062. return;
  1063. spin_lock_irqsave(&dev->vbl_lock, irqflags);
  1064. /* Drop our private "prevent drm_vblank_get" refcount */
  1065. if (vblank->inmodeset) {
  1066. atomic_dec(&vblank->refcount);
  1067. vblank->inmodeset = 0;
  1068. }
  1069. /*
  1070. * sample the current counter to avoid random jumps
  1071. * when drm_vblank_enable() applies the diff
  1072. *
  1073. * -1 to make sure user will never see the same
  1074. * vblank counter value before and after a modeset
  1075. */
  1076. vblank->last =
  1077. (dev->driver->get_vblank_counter(dev, crtc) - 1) &
  1078. dev->max_vblank_count;
  1079. /*
  1080. * re-enable interrupts if there are users left, or the
  1081. * user wishes vblank interrupts to be enabled all the time.
  1082. */
  1083. if (atomic_read(&vblank->refcount) != 0 ||
  1084. (!dev->vblank_disable_immediate && drm_vblank_offdelay == 0))
  1085. WARN_ON(drm_vblank_enable(dev, crtc));
  1086. spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
  1087. }
  1088. EXPORT_SYMBOL(drm_vblank_on);
  1089. /**
  1090. * drm_crtc_vblank_on - enable vblank events on a CRTC
  1091. * @crtc: CRTC in question
  1092. *
  1093. * This functions restores the vblank interrupt state captured with
  1094. * drm_vblank_off() again. Note that calls to drm_vblank_on() and
  1095. * drm_vblank_off() can be unbalanced and so can also be unconditionally called
  1096. * in driver load code to reflect the current hardware state of the crtc.
  1097. *
  1098. * This is the native kms version of drm_vblank_on().
  1099. */
  1100. void drm_crtc_vblank_on(struct drm_crtc *crtc)
  1101. {
  1102. drm_vblank_on(crtc->dev, drm_crtc_index(crtc));
  1103. }
  1104. EXPORT_SYMBOL(drm_crtc_vblank_on);
  1105. /**
  1106. * drm_vblank_pre_modeset - account for vblanks across mode sets
  1107. * @dev: DRM device
  1108. * @crtc: CRTC in question
  1109. *
  1110. * Account for vblank events across mode setting events, which will likely
  1111. * reset the hardware frame counter.
  1112. *
  1113. * This is done by grabbing a temporary vblank reference to ensure that the
  1114. * vblank interrupt keeps running across the modeset sequence. With this the
  1115. * software-side vblank frame counting will ensure that there are no jumps or
  1116. * discontinuities.
  1117. *
  1118. * Unfortunately this approach is racy and also doesn't work when the vblank
  1119. * interrupt stops running, e.g. across system suspend resume. It is therefore
  1120. * highly recommended that drivers use the newer drm_vblank_off() and
  1121. * drm_vblank_on() instead. drm_vblank_pre_modeset() only works correctly when
  1122. * using "cooked" software vblank frame counters and not relying on any hardware
  1123. * counters.
  1124. *
  1125. * Drivers must call drm_vblank_post_modeset() when re-enabling the same crtc
  1126. * again.
  1127. */
  1128. void drm_vblank_pre_modeset(struct drm_device *dev, int crtc)
  1129. {
  1130. struct drm_vblank_crtc *vblank = &dev->vblank[crtc];
  1131. /* vblank is not initialized (IRQ not installed ?), or has been freed */
  1132. if (!dev->num_crtcs)
  1133. return;
  1134. if (WARN_ON(crtc >= dev->num_crtcs))
  1135. return;
  1136. /*
  1137. * To avoid all the problems that might happen if interrupts
  1138. * were enabled/disabled around or between these calls, we just
  1139. * have the kernel take a reference on the CRTC (just once though
  1140. * to avoid corrupting the count if multiple, mismatch calls occur),
  1141. * so that interrupts remain enabled in the interim.
  1142. */
  1143. if (!vblank->inmodeset) {
  1144. vblank->inmodeset = 0x1;
  1145. if (drm_vblank_get(dev, crtc) == 0)
  1146. vblank->inmodeset |= 0x2;
  1147. }
  1148. }
  1149. EXPORT_SYMBOL(drm_vblank_pre_modeset);
  1150. /**
  1151. * drm_vblank_post_modeset - undo drm_vblank_pre_modeset changes
  1152. * @dev: DRM device
  1153. * @crtc: CRTC in question
  1154. *
  1155. * This function again drops the temporary vblank reference acquired in
  1156. * drm_vblank_pre_modeset.
  1157. */
  1158. void drm_vblank_post_modeset(struct drm_device *dev, int crtc)
  1159. {
  1160. struct drm_vblank_crtc *vblank = &dev->vblank[crtc];
  1161. unsigned long irqflags;
  1162. /* vblank is not initialized (IRQ not installed ?), or has been freed */
  1163. if (!dev->num_crtcs)
  1164. return;
  1165. if (vblank->inmodeset) {
  1166. spin_lock_irqsave(&dev->vbl_lock, irqflags);
  1167. dev->vblank_disable_allowed = true;
  1168. spin_unlock_irqrestore(&dev->vbl_lock, irqflags);
  1169. if (vblank->inmodeset & 0x2)
  1170. drm_vblank_put(dev, crtc);
  1171. vblank->inmodeset = 0;
  1172. }
  1173. }
  1174. EXPORT_SYMBOL(drm_vblank_post_modeset);
  1175. /*
  1176. * drm_modeset_ctl - handle vblank event counter changes across mode switch
  1177. * @DRM_IOCTL_ARGS: standard ioctl arguments
  1178. *
  1179. * Applications should call the %_DRM_PRE_MODESET and %_DRM_POST_MODESET
  1180. * ioctls around modesetting so that any lost vblank events are accounted for.
  1181. *
  1182. * Generally the counter will reset across mode sets. If interrupts are
  1183. * enabled around this call, we don't have to do anything since the counter
  1184. * will have already been incremented.
  1185. */
  1186. int drm_modeset_ctl(struct drm_device *dev, void *data,
  1187. struct drm_file *file_priv)
  1188. {
  1189. struct drm_modeset_ctl *modeset = data;
  1190. unsigned int crtc;
  1191. /* If drm_vblank_init() hasn't been called yet, just no-op */
  1192. if (!dev->num_crtcs)
  1193. return 0;
  1194. /* KMS drivers handle this internally */
  1195. if (drm_core_check_feature(dev, DRIVER_MODESET))
  1196. return 0;
  1197. crtc = modeset->crtc;
  1198. if (crtc >= dev->num_crtcs)
  1199. return -EINVAL;
  1200. switch (modeset->cmd) {
  1201. case _DRM_PRE_MODESET:
  1202. drm_vblank_pre_modeset(dev, crtc);
  1203. break;
  1204. case _DRM_POST_MODESET:
  1205. drm_vblank_post_modeset(dev, crtc);
  1206. break;
  1207. default:
  1208. return -EINVAL;
  1209. }
  1210. return 0;
  1211. }
  1212. static int drm_queue_vblank_event(struct drm_device *dev, int pipe,
  1213. union drm_wait_vblank *vblwait,
  1214. struct drm_file *file_priv)
  1215. {
  1216. struct drm_vblank_crtc *vblank = &dev->vblank[pipe];
  1217. struct drm_pending_vblank_event *e;
  1218. struct timeval now;
  1219. unsigned long flags;
  1220. unsigned int seq;
  1221. int ret;
  1222. e = kzalloc(sizeof *e, GFP_KERNEL);
  1223. if (e == NULL) {
  1224. ret = -ENOMEM;
  1225. goto err_put;
  1226. }
  1227. e->pipe = pipe;
  1228. e->base.pid = current->pid;
  1229. e->event.base.type = DRM_EVENT_VBLANK;
  1230. e->event.base.length = sizeof e->event;
  1231. e->event.user_data = vblwait->request.signal;
  1232. e->base.event = &e->event.base;
  1233. e->base.file_priv = file_priv;
  1234. e->base.destroy = (void (*) (struct drm_pending_event *)) kfree;
  1235. spin_lock_irqsave(&dev->event_lock, flags);
  1236. /*
  1237. * drm_vblank_off() might have been called after we called
  1238. * drm_vblank_get(). drm_vblank_off() holds event_lock
  1239. * around the vblank disable, so no need for further locking.
  1240. * The reference from drm_vblank_get() protects against
  1241. * vblank disable from another source.
  1242. */
  1243. if (!vblank->enabled) {
  1244. ret = -EINVAL;
  1245. goto err_unlock;
  1246. }
  1247. if (file_priv->event_space < sizeof e->event) {
  1248. ret = -EBUSY;
  1249. goto err_unlock;
  1250. }
  1251. file_priv->event_space -= sizeof e->event;
  1252. seq = drm_vblank_count_and_time(dev, pipe, &now);
  1253. if ((vblwait->request.type & _DRM_VBLANK_NEXTONMISS) &&
  1254. (seq - vblwait->request.sequence) <= (1 << 23)) {
  1255. vblwait->request.sequence = seq + 1;
  1256. vblwait->reply.sequence = vblwait->request.sequence;
  1257. }
  1258. DRM_DEBUG("event on vblank count %d, current %d, crtc %d\n",
  1259. vblwait->request.sequence, seq, pipe);
  1260. trace_drm_vblank_event_queued(current->pid, pipe,
  1261. vblwait->request.sequence);
  1262. e->event.sequence = vblwait->request.sequence;
  1263. if ((seq - vblwait->request.sequence) <= (1 << 23)) {
  1264. drm_vblank_put(dev, pipe);
  1265. send_vblank_event(dev, e, seq, &now);
  1266. vblwait->reply.sequence = seq;
  1267. } else {
  1268. /* drm_handle_vblank_events will call drm_vblank_put */
  1269. list_add_tail(&e->base.link, &dev->vblank_event_list);
  1270. vblwait->reply.sequence = vblwait->request.sequence;
  1271. }
  1272. spin_unlock_irqrestore(&dev->event_lock, flags);
  1273. return 0;
  1274. err_unlock:
  1275. spin_unlock_irqrestore(&dev->event_lock, flags);
  1276. kfree(e);
  1277. err_put:
  1278. drm_vblank_put(dev, pipe);
  1279. return ret;
  1280. }
  1281. /*
  1282. * Wait for VBLANK.
  1283. *
  1284. * \param inode device inode.
  1285. * \param file_priv DRM file private.
  1286. * \param cmd command.
  1287. * \param data user argument, pointing to a drm_wait_vblank structure.
  1288. * \return zero on success or a negative number on failure.
  1289. *
  1290. * This function enables the vblank interrupt on the pipe requested, then
  1291. * sleeps waiting for the requested sequence number to occur, and drops
  1292. * the vblank interrupt refcount afterwards. (vblank IRQ disable follows that
  1293. * after a timeout with no further vblank waits scheduled).
  1294. */
  1295. int drm_wait_vblank(struct drm_device *dev, void *data,
  1296. struct drm_file *file_priv)
  1297. {
  1298. struct drm_vblank_crtc *vblank;
  1299. union drm_wait_vblank *vblwait = data;
  1300. int ret;
  1301. unsigned int flags, seq, crtc, high_crtc;
  1302. if (!dev->irq_enabled)
  1303. return -EINVAL;
  1304. if (vblwait->request.type & _DRM_VBLANK_SIGNAL)
  1305. return -EINVAL;
  1306. if (vblwait->request.type &
  1307. ~(_DRM_VBLANK_TYPES_MASK | _DRM_VBLANK_FLAGS_MASK |
  1308. _DRM_VBLANK_HIGH_CRTC_MASK)) {
  1309. DRM_ERROR("Unsupported type value 0x%x, supported mask 0x%x\n",
  1310. vblwait->request.type,
  1311. (_DRM_VBLANK_TYPES_MASK | _DRM_VBLANK_FLAGS_MASK |
  1312. _DRM_VBLANK_HIGH_CRTC_MASK));
  1313. return -EINVAL;
  1314. }
  1315. flags = vblwait->request.type & _DRM_VBLANK_FLAGS_MASK;
  1316. high_crtc = (vblwait->request.type & _DRM_VBLANK_HIGH_CRTC_MASK);
  1317. if (high_crtc)
  1318. crtc = high_crtc >> _DRM_VBLANK_HIGH_CRTC_SHIFT;
  1319. else
  1320. crtc = flags & _DRM_VBLANK_SECONDARY ? 1 : 0;
  1321. if (crtc >= dev->num_crtcs)
  1322. return -EINVAL;
  1323. vblank = &dev->vblank[crtc];
  1324. ret = drm_vblank_get(dev, crtc);
  1325. if (ret) {
  1326. DRM_DEBUG("failed to acquire vblank counter, %d\n", ret);
  1327. return ret;
  1328. }
  1329. seq = drm_vblank_count(dev, crtc);
  1330. switch (vblwait->request.type & _DRM_VBLANK_TYPES_MASK) {
  1331. case _DRM_VBLANK_RELATIVE:
  1332. vblwait->request.sequence += seq;
  1333. vblwait->request.type &= ~_DRM_VBLANK_RELATIVE;
  1334. case _DRM_VBLANK_ABSOLUTE:
  1335. break;
  1336. default:
  1337. ret = -EINVAL;
  1338. goto done;
  1339. }
  1340. if (flags & _DRM_VBLANK_EVENT) {
  1341. /* must hold on to the vblank ref until the event fires
  1342. * drm_vblank_put will be called asynchronously
  1343. */
  1344. return drm_queue_vblank_event(dev, crtc, vblwait, file_priv);
  1345. }
  1346. if ((flags & _DRM_VBLANK_NEXTONMISS) &&
  1347. (seq - vblwait->request.sequence) <= (1<<23)) {
  1348. vblwait->request.sequence = seq + 1;
  1349. }
  1350. DRM_DEBUG("waiting on vblank count %d, crtc %d\n",
  1351. vblwait->request.sequence, crtc);
  1352. vblank->last_wait = vblwait->request.sequence;
  1353. DRM_WAIT_ON(ret, vblank->queue, 3 * HZ,
  1354. (((drm_vblank_count(dev, crtc) -
  1355. vblwait->request.sequence) <= (1 << 23)) ||
  1356. !vblank->enabled ||
  1357. !dev->irq_enabled));
  1358. if (ret != -EINTR) {
  1359. struct timeval now;
  1360. vblwait->reply.sequence = drm_vblank_count_and_time(dev, crtc, &now);
  1361. vblwait->reply.tval_sec = now.tv_sec;
  1362. vblwait->reply.tval_usec = now.tv_usec;
  1363. DRM_DEBUG("returning %d to client\n",
  1364. vblwait->reply.sequence);
  1365. } else {
  1366. DRM_DEBUG("vblank wait interrupted by signal\n");
  1367. }
  1368. done:
  1369. drm_vblank_put(dev, crtc);
  1370. return ret;
  1371. }
  1372. static void drm_handle_vblank_events(struct drm_device *dev, int crtc)
  1373. {
  1374. struct drm_pending_vblank_event *e, *t;
  1375. struct timeval now;
  1376. unsigned int seq;
  1377. assert_spin_locked(&dev->event_lock);
  1378. seq = drm_vblank_count_and_time(dev, crtc, &now);
  1379. list_for_each_entry_safe(e, t, &dev->vblank_event_list, base.link) {
  1380. if (e->pipe != crtc)
  1381. continue;
  1382. if ((seq - e->event.sequence) > (1<<23))
  1383. continue;
  1384. DRM_DEBUG("vblank event on %d, current %d\n",
  1385. e->event.sequence, seq);
  1386. list_del(&e->base.link);
  1387. drm_vblank_put(dev, e->pipe);
  1388. send_vblank_event(dev, e, seq, &now);
  1389. }
  1390. trace_drm_vblank_event(crtc, seq);
  1391. }
  1392. /**
  1393. * drm_handle_vblank - handle a vblank event
  1394. * @dev: DRM device
  1395. * @crtc: where this event occurred
  1396. *
  1397. * Drivers should call this routine in their vblank interrupt handlers to
  1398. * update the vblank counter and send any signals that may be pending.
  1399. */
  1400. bool drm_handle_vblank(struct drm_device *dev, int crtc)
  1401. {
  1402. struct drm_vblank_crtc *vblank = &dev->vblank[crtc];
  1403. u32 vblcount;
  1404. s64 diff_ns;
  1405. struct timeval tvblank;
  1406. unsigned long irqflags;
  1407. if (!dev->num_crtcs)
  1408. return false;
  1409. if (WARN_ON(crtc >= dev->num_crtcs))
  1410. return false;
  1411. spin_lock_irqsave(&dev->event_lock, irqflags);
  1412. /* Need timestamp lock to prevent concurrent execution with
  1413. * vblank enable/disable, as this would cause inconsistent
  1414. * or corrupted timestamps and vblank counts.
  1415. */
  1416. spin_lock(&dev->vblank_time_lock);
  1417. /* Vblank irq handling disabled. Nothing to do. */
  1418. if (!vblank->enabled) {
  1419. spin_unlock(&dev->vblank_time_lock);
  1420. spin_unlock_irqrestore(&dev->event_lock, irqflags);
  1421. return false;
  1422. }
  1423. /* Fetch corresponding timestamp for this vblank interval from
  1424. * driver and store it in proper slot of timestamp ringbuffer.
  1425. */
  1426. /* Get current timestamp and count. */
  1427. vblcount = atomic_read(&vblank->count);
  1428. drm_get_last_vbltimestamp(dev, crtc, &tvblank, DRM_CALLED_FROM_VBLIRQ);
  1429. /* Compute time difference to timestamp of last vblank */
  1430. diff_ns = timeval_to_ns(&tvblank) -
  1431. timeval_to_ns(&vblanktimestamp(dev, crtc, vblcount));
  1432. /* Update vblank timestamp and count if at least
  1433. * DRM_REDUNDANT_VBLIRQ_THRESH_NS nanoseconds
  1434. * difference between last stored timestamp and current
  1435. * timestamp. A smaller difference means basically
  1436. * identical timestamps. Happens if this vblank has
  1437. * been already processed and this is a redundant call,
  1438. * e.g., due to spurious vblank interrupts. We need to
  1439. * ignore those for accounting.
  1440. */
  1441. if (abs64(diff_ns) > DRM_REDUNDANT_VBLIRQ_THRESH_NS) {
  1442. /* Store new timestamp in ringbuffer. */
  1443. vblanktimestamp(dev, crtc, vblcount + 1) = tvblank;
  1444. /* Increment cooked vblank count. This also atomically commits
  1445. * the timestamp computed above.
  1446. */
  1447. smp_mb__before_atomic();
  1448. atomic_inc(&vblank->count);
  1449. smp_mb__after_atomic();
  1450. } else {
  1451. DRM_DEBUG("crtc %d: Redundant vblirq ignored. diff_ns = %d\n",
  1452. crtc, (int) diff_ns);
  1453. }
  1454. spin_unlock(&dev->vblank_time_lock);
  1455. wake_up(&vblank->queue);
  1456. drm_handle_vblank_events(dev, crtc);
  1457. spin_unlock_irqrestore(&dev->event_lock, irqflags);
  1458. return true;
  1459. }
  1460. EXPORT_SYMBOL(drm_handle_vblank);