1 /**************************************************************************
5 * Copyright 2015 Samsung Electronics co., Ltd. All Rights Reserved.
7 * Contact: Eunchul Kim <chulspro.kim@samsung.com>,
8 * JinYoung Jeon <jy0.jeon@samsung.com>,
9 * Taeheon Kim <th908.kim@samsung.com>,
10 * YoungJun Cho <yj44.cho@samsung.com>,
11 * SooChan Lim <sc1.lim@samsung.com>,
12 * Boram Park <sc1.lim@samsung.com>
14 * Permission is hereby granted, free of charge, to any person obtaining a
15 * copy of this software and associated documentation files (the
16 * "Software"), to deal in the Software without restriction, including
17 * without limitation the rights to use, copy, modify, merge, publish,
18 * distribute, sub license, and/or sell copies of the Software, and to
19 * permit persons to whom the Software is furnished to do so, subject to
20 * the following conditions:
22 * The above copyright notice and this permission notice (including the
23 * next paragraph) shall be included in all copies or substantial portions
26 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
27 * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
28 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT.
29 * IN NO EVENT SHALL PRECISION INSIGHT AND/OR ITS SUPPLIERS BE LIABLE FOR
30 * ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
31 * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
32 * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
34 **************************************************************************/
41 #include "tdm_private.h"
45 * tdm vblank doesn't care about thread things.
46 * However, to use tdm_event_loop_xxx functions, have to use the internal function.
47 * So need to lock/unlock the mutex of private_display.
51 * - aligned by HW vblank
52 * - use a tdm_event_loop_source object only.
55 /* We expact "(unsigned int)(0.0016667 / 0.0016667) = 1". But it becomes 0. */
56 #define TDM_TIME_MARGIN 0.0000001
58 #define TDM_VBLANK_UINT_MAX 4294967295U
59 #define TDM_VBLANK_UINT_1Q 1073741823U /* UINT_MAX / 4 */
60 #define TDM_VBLANK_UINT_3Q 3221225471U /* UINT_MAX / 4 * 3 */
62 /* (seq < TDM_VBLANK_UINT_1Q && TDM_VBLANK_UINT_3Q < last_seq) means
63 * that the sequence value has reached the max value and started from 0 again.
65 #define TDM_VBLANK_SEQ_REACHED_MAX(seq, last_seq) \
66 ((seq) < TDM_VBLANK_UINT_1Q && TDM_VBLANK_UINT_3Q < (last_seq))
68 #define VER(fmt, arg...) TDM_ERR("[%p] "fmt, private_vblank, ##arg)
69 #define VWR(fmt, arg...) TDM_WRN("[%p] "fmt, private_vblank, ##arg)
70 #define VIN(fmt, arg...) TDM_INFO("[%p] "fmt, private_vblank, ##arg)
71 #define VDB(fmt, arg...) TDM_DBG("[%p] "fmt, private_vblank, ##arg)
78 } tdm_vblank_wait_type;
80 typedef struct _tdm_vblank_wait_info tdm_vblank_wait_info;
82 typedef struct _tdm_private_vblank {
83 struct list_head link;
91 unsigned int vrefresh;
93 unsigned int check_HW_or_SW;
96 unsigned int enable_fake;
99 unsigned int quotient;
101 unsigned int last_seq;
105 double HW_vblank_gap;
106 struct list_head HW_wait_list;
109 tdm_event_loop_source *SW_timer;
110 struct list_head SW_wait_list;
111 } tdm_private_vblank;
113 struct _tdm_vblank_wait_info {
114 struct list_head link;
115 struct list_head valid_link;
120 unsigned int interval;
122 tdm_vblank_handler func;
124 tdm_private_vblank *private_vblank;
126 tdm_vblank_wait_type type;
129 unsigned int target_seq;
132 static pthread_mutex_t vblank_list_lock;
133 static struct list_head vblank_list;
134 static struct list_head valid_wait_list;
135 static unsigned int vblank_list_inited;
136 static double stamp = 0;
138 static tdm_error _tdm_vblank_cb_vblank_SW(void *user_data);
139 static tdm_error _tdm_vblank_wait_SW(tdm_vblank_wait_info *wait_info);
143 _print_list(struct list_head *list)
145 tdm_vblank_wait_info *w = NULL;
147 LIST_FOR_EACH_ENTRY(w, list, link) {
148 printf(" %d", w->interval);
154 static inline tdm_private_vblank*
155 _tdm_vblank_find(double vblank_stamp)
157 tdm_private_vblank *v = NULL;
162 pthread_mutex_lock(&vblank_list_lock);
163 LIST_FOR_EACH_ENTRY(v, &vblank_list, link) {
164 if (v->stamp == vblank_stamp) {
165 pthread_mutex_unlock(&vblank_list_lock);
169 pthread_mutex_unlock(&vblank_list_lock);
174 static inline unsigned int
175 _tdm_vblank_check_valid_wait(tdm_vblank_wait_info *wait_info)
177 tdm_vblank_wait_info *w = NULL;
182 LIST_FOR_EACH_ENTRY(w, &valid_wait_list, valid_link) {
183 if (w->stamp == wait_info->stamp)
190 static inline unsigned int
191 _tdm_vblank_find_wait(tdm_vblank_wait_info *wait_info, struct list_head *list)
193 tdm_vblank_wait_info *w = NULL;
198 LIST_FOR_EACH_ENTRY(w, list, link) {
199 if (w->stamp == wait_info->stamp)
207 _tdm_vblank_insert_wait(tdm_vblank_wait_info *wait_info, struct list_head *list)
209 tdm_vblank_wait_info *w = NULL;
210 tdm_vblank_wait_info *found = NULL;
212 if (LIST_IS_EMPTY(list)) {
213 LIST_ADDTAIL(&wait_info->link, list);
217 LIST_FOR_EACH_ENTRY(w, list, link) {
218 if (wait_info->type == VBLANK_TYPE_SW) {
219 if (wait_info->target_time == 0)
220 TDM_NEVER_GET_HERE();
221 if (w->target_time <= wait_info->target_time) {
226 if (w->interval <= wait_info->interval) {
234 LIST_ADD(&wait_info->link, &found->link);
236 LIST_ADDTAIL(&wait_info->link, list->next);
240 _tdm_vblank_change_to_SW(tdm_private_vblank *private_vblank)
242 tdm_vblank_wait_info *w = NULL, *ww = NULL;
244 LIST_FOR_EACH_ENTRY_SAFE(w, ww, &private_vblank->HW_wait_list, link) {
246 w->type = VBLANK_TYPE_SW_FAKE;
247 _tdm_vblank_wait_SW(w);
252 _tdm_vblank_free_HW_wait(tdm_private_vblank *private_vblank, tdm_error error, unsigned int call_cb)
254 tdm_vblank_wait_info *w = NULL, *ww = NULL;
256 LIST_FOR_EACH_ENTRY_SAFE(w, ww, &private_vblank->HW_wait_list, link) {
258 LIST_DEL(&w->valid_link);
260 if (call_cb && w->func)
261 w->func(private_vblank, error, 0, 0, 0, w->user_data);
268 _tdm_vblank_cb_output_change(tdm_output *output, tdm_output_change_type type,
269 tdm_value value, void *user_data)
271 tdm_private_vblank *private_vblank = user_data;
273 TDM_RETURN_IF_FAIL(private_vblank != NULL);
276 case TDM_OUTPUT_CHANGE_DPMS:
277 if (private_vblank->dpms == value.u32)
279 VIN("dpms %s", tdm_dpms_str(value.u32));
280 private_vblank->dpms = value.u32;
281 private_vblank->check_HW_or_SW = 1;
282 if (private_vblank->dpms != TDM_OUTPUT_DPMS_ON) {
283 if (private_vblank->enable_fake)
284 _tdm_vblank_change_to_SW(private_vblank);
286 _tdm_vblank_free_HW_wait(private_vblank, TDM_ERROR_DPMS_OFF, 1);
289 case TDM_OUTPUT_CHANGE_CONNECTION:
290 VIN("output %s", tdm_status_str(value.u32));
291 if (value.u32 == TDM_OUTPUT_CONN_STATUS_DISCONNECTED)
292 _tdm_vblank_free_HW_wait(private_vblank, 0, 0);
300 tdm_vblank_create(tdm_display *dpy, tdm_output *output, tdm_error *error)
302 tdm_private_vblank *private_vblank;
303 const tdm_output_mode *mode = NULL;
304 tdm_output_dpms dpms = TDM_OUTPUT_DPMS_ON;
307 TDM_RETURN_VAL_IF_FAIL_WITH_ERROR(dpy != NULL, TDM_ERROR_INVALID_PARAMETER, NULL);
308 TDM_RETURN_VAL_IF_FAIL_WITH_ERROR(output != NULL, TDM_ERROR_INVALID_PARAMETER, NULL);
311 *error = TDM_ERROR_NONE;
313 if (!vblank_list_inited) {
314 if (pthread_mutex_init(&vblank_list_lock, NULL)) {
315 TDM_ERR("mutex init failed: %m");
317 *error = TDM_ERROR_OPERATION_FAILED;
320 LIST_INITHEAD(&vblank_list);
321 LIST_INITHEAD(&valid_wait_list);
322 vblank_list_inited = 1;
325 tdm_output_get_mode(output, &mode);
328 *error = TDM_ERROR_OPERATION_FAILED;
333 tdm_output_get_dpms(output, &dpms);
335 private_vblank = calloc(1, sizeof *private_vblank);
336 if (!private_vblank) {
338 *error = TDM_ERROR_OUT_OF_MEMORY;
343 tdm_output_add_change_handler(output, _tdm_vblank_cb_output_change, private_vblank);
345 private_vblank->stamp = ++stamp;
346 private_vblank->owner_tid = syscall(SYS_gettid);
347 private_vblank->dpy = dpy;
348 private_vblank->output = output;
349 private_vblank->dpms = dpms;
350 private_vblank->vrefresh = mode->vrefresh;
351 private_vblank->HW_vblank_gap = 1.0 / private_vblank->vrefresh;
353 private_vblank->check_HW_or_SW = 1;
354 private_vblank->fps = mode->vrefresh;
356 LIST_INITHEAD(&private_vblank->HW_wait_list);
357 LIST_INITHEAD(&private_vblank->SW_wait_list);
359 pthread_mutex_lock(&vblank_list_lock);
360 LIST_ADD(&private_vblank->link, &vblank_list);
361 pthread_mutex_unlock(&vblank_list_lock);
363 if (tdm_debug_module & TDM_DEBUG_VBLANK)
364 VIN("created. vrefresh(%d) dpms(%d)",
365 private_vblank->vrefresh, private_vblank->dpms);
367 return (tdm_vblank*)private_vblank;
371 tdm_vblank_destroy(tdm_vblank *vblank)
373 tdm_private_vblank *private_vblank = vblank;
374 tdm_vblank_wait_info *w = NULL, *ww = NULL;
379 pthread_mutex_lock(&vblank_list_lock);
380 LIST_DEL(&private_vblank->link);
381 pthread_mutex_unlock(&vblank_list_lock);
383 if (private_vblank->SW_timer) {
384 tdm_display_lock(private_vblank->dpy);
385 tdm_event_loop_source_remove(private_vblank->SW_timer);
386 tdm_display_unlock(private_vblank->dpy);
389 tdm_output_remove_change_handler(private_vblank->output,
390 _tdm_vblank_cb_output_change, private_vblank);
392 _tdm_vblank_free_HW_wait(private_vblank, 0, 0);
394 LIST_FOR_EACH_ENTRY_SAFE(w, ww, &private_vblank->SW_wait_list, link) {
396 LIST_DEL(&w->valid_link);
400 if (tdm_debug_module & TDM_DEBUG_VBLANK)
403 free(private_vblank);
407 tdm_vblank_set_fps(tdm_vblank *vblank, unsigned int fps)
409 tdm_private_vblank *private_vblank = vblank;
411 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
412 TDM_RETURN_VAL_IF_FAIL(fps > 0, TDM_ERROR_INVALID_PARAMETER);
414 if (private_vblank->fps == fps)
415 return TDM_ERROR_NONE;
417 private_vblank->fps = fps;
418 private_vblank->check_HW_or_SW = 1;
420 if (tdm_debug_module & TDM_DEBUG_VBLANK)
421 VIN("fps(%d)", private_vblank->fps);
423 return TDM_ERROR_NONE;
427 tdm_vblank_set_offset(tdm_vblank *vblank, int offset)
429 tdm_private_vblank *private_vblank = vblank;
431 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
433 if (private_vblank->offset == offset)
434 return TDM_ERROR_NONE;
436 private_vblank->offset = offset;
437 private_vblank->check_HW_or_SW = 1;
439 if (tdm_debug_module & TDM_DEBUG_VBLANK)
440 VIN("offset(%d)", private_vblank->offset);
442 return TDM_ERROR_NONE;
446 tdm_vblank_set_enable_fake(tdm_vblank *vblank, unsigned int enable_fake)
448 tdm_private_vblank *private_vblank = vblank;
450 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
452 if (private_vblank->enable_fake == enable_fake)
453 return TDM_ERROR_NONE;
455 private_vblank->enable_fake = enable_fake;
457 if (tdm_debug_module & TDM_DEBUG_VBLANK)
458 VIN("enable_fake(%d)", private_vblank->enable_fake);
460 return TDM_ERROR_NONE;
464 tdm_vblank_get_enable_fake(tdm_vblank *vblank)
466 tdm_private_vblank *private_vblank = vblank;
468 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, 0);
470 return private_vblank->enable_fake;
474 _tdm_vblank_sw_timer_update(tdm_private_vblank *private_vblank)
476 tdm_vblank_wait_info *first_wait_info = NULL;
481 if (LIST_IS_EMPTY(&private_vblank->SW_wait_list)) {
483 return TDM_ERROR_OPERATION_FAILED;
486 first_wait_info = container_of(private_vblank->SW_wait_list.next, first_wait_info, link);
487 curr = tdm_helper_get_time();
488 target = first_wait_info->target_time;
490 /* ms_delay should be more that 1 */
494 ms_delay = ceil((target - curr) * 1000.0);
500 VER("wait(%p) curr(%.6f) target(%.6f) ms_delay(%d)", first_wait_info, curr, target, ms_delay);
501 else if (tdm_debug_module & TDM_DEBUG_VBLANK)
502 VIN("wait(%p) curr(%.6f) target(%.6f) ms_delay(%d)", first_wait_info, curr, target, ms_delay);
504 tdm_display_lock(private_vblank->dpy);
506 if (!private_vblank->SW_timer) {
507 private_vblank->SW_timer =
508 tdm_event_loop_add_timer_handler(private_vblank->dpy,
509 _tdm_vblank_cb_vblank_SW,
512 if (!private_vblank->SW_timer) {
513 tdm_display_unlock(private_vblank->dpy);
514 VER("couldn't add timer");
517 VIN("Use SW vblank");
520 ret = tdm_event_loop_source_timer_update(private_vblank->SW_timer, ms_delay);
521 if (ret != TDM_ERROR_NONE) {
522 tdm_display_unlock(private_vblank->dpy);
523 VER("couldn't update timer");
527 tdm_display_unlock(private_vblank->dpy);
529 return TDM_ERROR_NONE;
533 _tdm_vblank_cb_vblank_HW(tdm_output *output, unsigned int sequence,
534 unsigned int tv_sec, unsigned int tv_usec,
537 tdm_vblank_wait_info *wait_info = user_data;
538 tdm_private_vblank *private_vblank;
540 if (!_tdm_vblank_check_valid_wait(wait_info)) {
541 TDM_DBG("can't find wait(%p) from valid_wait_list", wait_info);
545 private_vblank = wait_info->private_vblank;
546 TDM_RETURN_IF_FAIL(private_vblank != NULL);
548 if (!_tdm_vblank_find_wait(wait_info, &private_vblank->HW_wait_list)) {
549 VDB("can't find wait(%p)", wait_info);
553 if (wait_info->type == VBLANK_TYPE_HW_SW) {
556 LIST_DEL(&wait_info->link);
558 /* kernel sends the wrong time of first vblank event. and the time of
559 * second vblank is correct.
561 wait_info->target_time = TDM_TIME(tv_sec, tv_usec);
562 wait_info->target_time += (((double)private_vblank->offset) / 1000.0);
564 _tdm_vblank_insert_wait(wait_info, &private_vblank->SW_wait_list);
566 ret = _tdm_vblank_sw_timer_update(private_vblank);
568 /* wait_info will be freed in _tdm_vblank_cb_vblank_SW() */
569 if (ret == TDM_ERROR_NONE) {
570 if (tdm_debug_module & TDM_DEBUG_VBLANK)
571 VIN("wait(%p) SW timer", wait_info);
575 VWR("couldn't update sw timer");
578 if (private_vblank->last_seq >= wait_info->target_seq)
579 TDM_ERR("last_seq(%u) target_seq(%u)", private_vblank->last_seq, wait_info->target_seq);
581 /* tv_sec & tv_usec shouldn't be zero. But sometimes they are zero in some hardware.
582 * We need to prohibit that last_time becomes zero because "last_time == 0" means
583 * that a tdm_vblank object is just created and doesn't have the first vblank event.
584 * If last_time becomes 0, it would make issue.
586 if (tv_sec == 0 && tv_usec == 0) {
587 double curr = tdm_helper_get_time();
588 tv_sec = TDM_TIME_SEC(curr);
589 tv_usec = TDM_TIME_USEC(curr);
592 private_vblank->last_seq = wait_info->target_seq;
593 private_vblank->last_time = TDM_TIME(tv_sec, tv_usec);
595 if (tdm_debug_module & TDM_DEBUG_VBLANK)
596 VIN("wait(%p) last(%.6f) sequence(%u) done", wait_info, private_vblank->last_time, wait_info->target_seq);
599 wait_info->func(private_vblank, TDM_ERROR_NONE, wait_info->target_seq,
600 tv_sec, tv_usec, wait_info->user_data);
602 LIST_DEL(&wait_info->link);
603 LIST_DEL(&wait_info->valid_link);
608 _tdm_vblank_wait_HW(tdm_vblank_wait_info *wait_info)
610 tdm_private_vblank *private_vblank = wait_info->private_vblank;
614 _tdm_vblank_insert_wait(wait_info, &private_vblank->HW_wait_list);
616 hw_interval = wait_info->interval * private_vblank->quotient;
618 if (private_vblank->last_time == 0) {
619 /* SW vblank starts from now. SW vblank doesn't need to be aligned with HW vblank. */
620 private_vblank->last_seq = 0;
621 private_vblank->last_time = tdm_helper_get_time();
623 /* +1 ms to call the handler ASAP at the first. no matter for SW timer. */
624 wait_info->target_seq = 1;
625 if (tdm_debug_module & TDM_DEBUG_VBLANK)
626 VIN("wait(%p) last(%.6f) hw_itvl(%d) targ_seq(%u)",
627 wait_info, private_vblank->last_time, hw_interval, wait_info->target_seq);
629 double last, prev, req, curr, target;
632 last = private_vblank->last_time;
633 req = wait_info->req_time;
635 skip = (unsigned int)((req - last) / private_vblank->vblank_gap + TDM_TIME_MARGIN);
636 prev = last + private_vblank->vblank_gap * skip;
638 curr = tdm_helper_get_time();
640 while (target < curr)
641 target += private_vblank->vblank_gap;
643 hw_interval = (unsigned int)((target - curr) / private_vblank->HW_vblank_gap + TDM_TIME_MARGIN) + 1;
645 wait_info->target_seq = private_vblank->last_seq;
646 wait_info->target_seq += (unsigned int)((target - last) / private_vblank->vblank_gap + TDM_TIME_MARGIN);
648 if (hw_interval > 300)
649 VER("wait(%p) last(%.6f) req(%.6f) prev(%.6f) curr(%.6f) targ(%.6f,%.6f) skip(%u) hw_itvl(%d) targ_seq(%u)",
650 wait_info, last, req - last, prev - last, curr - last, target, target - last,
651 skip, hw_interval, wait_info->target_seq);
652 else if (tdm_debug_module & TDM_DEBUG_VBLANK)
653 VIN("wait(%p) last(%.6f) req(%.6f) prev(%.6f) curr(%.6f) targ(%.6f,%.6f) skip(%u) hw_itvl(%d) targ_seq(%u)",
654 wait_info, last, req - last, prev - last, curr - last, target, target - last,
655 skip, hw_interval, wait_info->target_seq);
658 ret = tdm_output_wait_vblank(private_vblank->output, hw_interval, 0,
659 _tdm_vblank_cb_vblank_HW, wait_info);
661 if (ret != TDM_ERROR_NONE) {
662 LIST_DEL(&wait_info->link);
666 if (tdm_debug_module & TDM_DEBUG_VBLANK)
667 VIN("wait(%p) waiting", wait_info);
669 return TDM_ERROR_NONE;
673 _tdm_vblank_cb_vblank_SW(void *user_data)
675 tdm_private_vblank *private_vblank = user_data;
677 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_OPERATION_FAILED);
679 return tdm_vblank_cb_vblank_SW(private_vblank, 0);
683 tdm_vblank_cb_vblank_SW(tdm_vblank *vblank, double vblank_stamp)
685 tdm_private_vblank *private_vblank;
686 tdm_vblank_wait_info *first_wait_info = NULL, *w = NULL, *ww = NULL;
688 TDM_RETURN_VAL_IF_FAIL(vblank || vblank_stamp > 0, TDM_ERROR_INVALID_PARAMETER);
691 private_vblank = vblank;
693 private_vblank = _tdm_vblank_find(vblank_stamp);
694 if (!private_vblank) {
695 TDM_DBG("can't find vblank(%.0f) from valid_list", vblank_stamp);
696 return TDM_ERROR_NONE;
700 if (private_vblank->owner_tid != syscall(SYS_gettid)) {
701 tdm_thread_cb_vblank_sw vblank_sw;
702 tdm_private_display *private_display = private_vblank->dpy;
705 vblank_sw.base.type = TDM_THREAD_CB_VBLANK_SW;
706 vblank_sw.base.length = sizeof vblank_sw;
707 vblank_sw.vblank_stamp = private_vblank->stamp;
709 ret = tdm_thread_send_cb(private_display->private_loop, &vblank_sw.base);
710 TDM_WARNING_IF_FAIL(ret == TDM_ERROR_NONE);
712 return TDM_ERROR_NONE;
715 if (LIST_IS_EMPTY(&private_vblank->SW_wait_list)) {
717 return TDM_ERROR_OPERATION_FAILED;
720 first_wait_info = container_of(private_vblank->SW_wait_list.next, first_wait_info, link);
721 TDM_RETURN_VAL_IF_FAIL(first_wait_info != NULL, TDM_ERROR_OPERATION_FAILED);
723 if (private_vblank->last_seq >= first_wait_info->target_seq)
724 TDM_ERR("last_seq(%u) target_seq(%u)", private_vblank->last_seq, first_wait_info->target_seq);
726 private_vblank->last_seq = first_wait_info->target_seq;
727 private_vblank->last_time = first_wait_info->target_time;
729 if (tdm_debug_module & TDM_DEBUG_VBLANK)
730 VIN("wait(%p) last(%.6f) sequence(%u) done", first_wait_info, private_vblank->last_time, first_wait_info->target_seq);
732 LIST_FOR_EACH_ENTRY_SAFE(w, ww, &private_vblank->SW_wait_list, link) {
733 if (w->target_time != first_wait_info->target_time)
737 LIST_DEL(&w->valid_link);
740 tdm_display_unlock(private_vblank->dpy);
741 w->func(private_vblank, TDM_ERROR_NONE, w->target_seq,
742 TDM_TIME_SEC(w->target_time), TDM_TIME_USEC(w->target_time),
744 tdm_display_lock(private_vblank->dpy);
750 return TDM_ERROR_NONE;
754 _tdm_vblank_wait_SW(tdm_vblank_wait_info *wait_info)
756 tdm_private_vblank *private_vblank = wait_info->private_vblank;
759 if (private_vblank->last_time == 0) {
760 /* SW vblank starts from now. SW vblank doesn't need to be aligned with HW vblank. */
761 private_vblank->last_seq = 0;
762 private_vblank->last_time = tdm_helper_get_time();
764 /* +1 ms to call the handler ASAP at the first. no matter for SW timer. */
765 wait_info->target_seq = 1;
766 wait_info->target_time = private_vblank->last_time + 0.001;
768 if (tdm_debug_module & TDM_DEBUG_VBLANK)
769 VIN("wait(%p) last(%.6f) target(%.6f) target sequence(%u)",
770 wait_info, private_vblank->last_time, wait_info->target_time, wait_info->target_seq);
772 double last, prev, req, curr, target;
775 last = private_vblank->last_time;
776 req = wait_info->req_time;
778 skip = (unsigned int)((req - last) / private_vblank->vblank_gap + TDM_TIME_MARGIN);
779 prev = last + private_vblank->vblank_gap * skip;
781 curr = tdm_helper_get_time();
782 target = prev + private_vblank->vblank_gap * wait_info->interval;
784 while (target < curr)
785 target += private_vblank->vblank_gap;
787 wait_info->target_seq = private_vblank->last_seq;
788 wait_info->target_seq += (unsigned int)((target - last) / private_vblank->vblank_gap + TDM_TIME_MARGIN);
790 wait_info->target_time = target;
792 if (tdm_debug_module & TDM_DEBUG_VBLANK)
793 VIN("wait(%p) last(%.6f) req(%.6f) prev(%.6f) curr(%.6f) targ(%.6f,%.6f) skip(%u) targ_seq(%u)",
794 wait_info, last, req - last, prev - last, curr - last,
795 target, target - last, skip, wait_info->target_seq);
798 _tdm_vblank_insert_wait(wait_info, &private_vblank->SW_wait_list);
800 ret = _tdm_vblank_sw_timer_update(private_vblank);
801 if (ret != TDM_ERROR_NONE) {
802 LIST_DEL(&wait_info->link);
803 VER("couldn't update sw timer");
807 return TDM_ERROR_NONE;
811 tdm_vblank_wait(tdm_vblank *vblank, unsigned int req_sec, unsigned int req_usec,
812 unsigned int interval, tdm_vblank_handler func, void *user_data)
814 tdm_private_vblank *private_vblank = vblank;
815 tdm_vblank_wait_info *wait_info;
818 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
819 TDM_RETURN_VAL_IF_FAIL(func != NULL, TDM_ERROR_INVALID_PARAMETER);
821 if (private_vblank->owner_tid != syscall(SYS_gettid)) {
822 TDM_ERR("SHOULD be called in the owner thread");
823 return TDM_ERROR_BAD_REQUEST;
826 if (private_vblank->dpms != TDM_OUTPUT_DPMS_ON && !private_vblank->enable_fake) {
827 VIN("can't wait a vblank because of DPMS off");
828 return TDM_ERROR_DPMS_OFF;
831 wait_info = calloc(1, sizeof *wait_info);
834 return TDM_ERROR_OUT_OF_MEMORY;
837 /* set request time to current time if 0. This function seems to be called in server side. */
838 if (req_sec == 0 && req_usec == 0) {
839 double curr = tdm_helper_get_time();
840 req_sec = TDM_TIME_SEC(curr);
841 req_usec = TDM_TIME_USEC(curr);
844 LIST_INITHEAD(&wait_info->link);
845 LIST_ADDTAIL(&wait_info->valid_link, &valid_wait_list);
846 wait_info->stamp = ++stamp;
847 wait_info->req_time = TDM_TIME(req_sec, req_usec);
848 wait_info->interval = interval;
849 wait_info->func = func;
850 wait_info->user_data = user_data;
851 wait_info->private_vblank = private_vblank;
853 if (private_vblank->check_HW_or_SW) {
854 private_vblank->check_HW_or_SW = 0;
855 private_vblank->vblank_gap = 1.0 / private_vblank->fps;
856 private_vblank->quotient = private_vblank->vrefresh / private_vblank->fps;
859 /* 1) if fps != factor of vrefresh, SW timer
860 * 2) if fps == factor of vrefresh && dpms == off, SW timer (Fake HW vblank)
861 * 2) if fps == factor of vrefresh && dpms == on && offset == 0, HW vblank
862 * 3) if fps == factor of vrefresh && dpms == on && offset != 0, HW vblank + SW timer
863 * In case of 1), we really don't need to align with HW vblank.
865 if (private_vblank->vrefresh % private_vblank->fps)
866 wait_info->type = VBLANK_TYPE_SW;
867 else if (private_vblank->dpms == TDM_OUTPUT_DPMS_OFF)
868 wait_info->type = VBLANK_TYPE_SW_FAKE;
869 else if (private_vblank->offset == 0)
870 wait_info->type = VBLANK_TYPE_HW;
872 wait_info->type = VBLANK_TYPE_HW_SW;
874 if (wait_info->type == VBLANK_TYPE_SW || wait_info->type == VBLANK_TYPE_SW_FAKE)
875 ret = _tdm_vblank_wait_SW(wait_info);
877 ret = _tdm_vblank_wait_HW(wait_info);
878 if (ret == TDM_ERROR_DPMS_OFF)
879 ret = _tdm_vblank_wait_SW(wait_info);
882 if (ret != TDM_ERROR_NONE) {
883 LIST_DEL(&wait_info->link);
884 LIST_DEL(&wait_info->valid_link);
889 return TDM_ERROR_NONE;
893 tdm_vblank_wait_seq(tdm_vblank *vblank, unsigned int req_sec, unsigned int req_usec,
894 unsigned int sequence, tdm_vblank_handler func, void *user_data)
896 tdm_private_vblank *private_vblank = vblank;
897 unsigned int interval;
899 TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
900 TDM_RETURN_VAL_IF_FAIL(func != NULL, TDM_ERROR_INVALID_PARAMETER);
902 /* if the sequence of vblank reaches the max value, sequence can be 0. */
904 if (private_vblank->last_seq == 0) {
905 TDM_WRN("can't calculate interval with sequence(%u)", sequence);
907 } else if (sequence > private_vblank->last_seq ||
908 TDM_VBLANK_SEQ_REACHED_MAX(sequence, private_vblank->last_seq)) {
909 double last, curr, seq_target;
911 last = private_vblank->last_time;
912 curr = tdm_helper_get_time();
913 seq_target = last + private_vblank->vblank_gap * (sequence - private_vblank->last_seq);
915 /* If target is old or too close(1ms) to current, we call the handler immediately.
916 * 2ms? it seems too much.
918 if (seq_target < curr) {
919 func(vblank, TDM_ERROR_NONE, sequence,
920 TDM_TIME_SEC(seq_target), TDM_TIME_USEC(seq_target),
922 return TDM_ERROR_NONE;
923 } else if ((seq_target - curr) < 0.001) { /* 1ms */
924 func(vblank, TDM_ERROR_NONE, sequence,
925 TDM_TIME_SEC(curr), TDM_TIME_USEC(curr),
927 return TDM_ERROR_NONE;
930 interval = (unsigned int)((seq_target - curr) / private_vblank->vblank_gap + TDM_TIME_MARGIN) + 1;
932 /* this seems error. But we handle this like normal to avoid the unexpected error in cliend side */
933 TDM_WRN("sequence(%u) should be over the last sequence(%u)", sequence, private_vblank->last_seq);
934 func(vblank, TDM_ERROR_NONE, private_vblank->last_seq,
935 TDM_TIME_SEC(private_vblank->last_time), TDM_TIME_USEC(private_vblank->last_time),
937 return TDM_ERROR_NONE;
940 return tdm_vblank_wait(vblank, req_sec, req_usec, interval, func, user_data);