src/tdm_vblank.c

   1 /**************************************************************************
   2  *
   3  * libtdm
   4  *
   5  * Copyright 2015 Samsung Electronics co., Ltd. All Rights Reserved.
   6  *
   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>
  13  *
  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:
  21  *
  22  * The above copyright notice and this permission notice (including the
  23  * next paragraph) shall be included in all copies or substantial portions
  24  * of the Software.
  25  *
  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.
  33  *
  34 **************************************************************************/
  35
  36 #ifdef HAVE_CONFIG_H
  37 #include "config.h"
  38 #endif
  39
  40 #include "tdm.h"
  41 #include "tdm_private.h"
  42 #include "tdm_list.h"
  43
  44 /* CAUTION:
  45  * Basically 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. And valid_vblank_list and
  48  * valid_wait_list should be protected by valid_list_lock because tdm_vblank can
  49  * be used in multi-thread.
  50  */
  51
  52 /* TDM vblank
  53  * - aligned by HW vblank
  54  * - use a tdm_event_loop_source object only.
  55  */
  56
  57 #define TDM_VBLANK_DEFAULT_VREFRESH    30
  58
  59 /* We expact "(unsigned int)(0.0016667 / 0.0016667) = 1". But it becomes 0. */
  60 #define TDM_TIME_MARGIN     0.0000001
  61
  62 #define TDM_VBLANK_UINT_MAX 4294967295U
  63 #define TDM_VBLANK_UINT_1Q  1073741823U     /* UINT_MAX / 4 */
  64 #define TDM_VBLANK_UINT_3Q  3221225471U     /* UINT_MAX / 4 * 3 */
  65
  66 /* (seq < TDM_VBLANK_UINT_1Q && TDM_VBLANK_UINT_3Q < last_seq) means
  67  * that the sequence value has reached the max value and started from 0 again.
  68  */
  69 #define TDM_VBLANK_SEQ_REACHED_MAX(seq, last_seq) \
  70         ((seq) < TDM_VBLANK_UINT_1Q && TDM_VBLANK_UINT_3Q < (last_seq))
  71
  72 #define VER(fmt, arg...)   TDM_ERR("[%p] "fmt, private_vblank, ##arg)
  73 #define VWR(fmt, arg...)   TDM_WRN("[%p] "fmt, private_vblank, ##arg)
  74 #define VIN(fmt, arg...)   do { if (tdm_debug_module & TDM_DEBUG_VBLANK) TDM_INFO("[%p] "fmt, private_vblank, ##arg); } while (0)
  75 #define VDB(fmt, arg...)   do { if (tdm_debug_module & TDM_DEBUG_VBLANK) TDM_DBG("[%p] "fmt, private_vblank, ##arg); } while (0)
  76
  77 typedef enum {
  78         VBLANK_TYPE_SW,
  79         VBLANK_TYPE_SW_FAKE,
  80         VBLANK_TYPE_HW,
  81         VBLANK_TYPE_HW_SW,
  82 } tdm_vblank_wait_type;
  83
  84 typedef enum {
  85         VBLANK_EVENT_TYPE_NONE,
  86         VBLANK_EVENT_TYPE_SW,
  87         VBLANK_EVENT_TYPE_HW,
  88 } tdm_vblank_event_type;
  89
  90 typedef struct _tdm_vblank_wait_info tdm_vblank_wait_info;
  91
  92 typedef struct _tdm_private_vblank {
  93         struct list_head valid_link;
  94
  95         double stamp;
  96         pid_t owner_tid;
  97
  98         tdm_display *dpy;
  99         tdm_output *output;
 100         tdm_output_conn_status connection;
 101         unsigned int vrefresh;
 102
 103         tdm_vblank_event_type last_type;
 104         unsigned int check_HW_or_SW;
 105         char name[TDM_NAME_LEN];
 106         unsigned int fps;
 107         unsigned int fps_changeable;
 108         int offset;
 109         unsigned int enable_fake;
 110         unsigned int ignore_global_fps;
 111
 112         double vblank_gap;
 113         unsigned int quotient;
 114
 115         int last_interval;
 116         unsigned int last_seq;
 117         double last_time;
 118
 119         unsigned int add_front;
 120         struct wl_resource *resource;
 121
 122         /* for HW */
 123         double HW_vblank_gap;
 124         struct list_head HW_wait_list;
 125
 126         /* for SW */
 127         tdm_event_loop_source *SW_timer;
 128         struct list_head SW_wait_list;
 129 } tdm_private_vblank;
 130
 131 struct _tdm_vblank_wait_info {
 132         struct list_head link;
 133         struct list_head valid_link;
 134
 135         double stamp;
 136
 137         double req_time;
 138         unsigned int interval;
 139
 140         tdm_vblank_handler func;
 141         void *user_data;
 142         tdm_private_vblank *private_vblank;
 143
 144         tdm_vblank_wait_type type;
 145
 146         double target_time;
 147         unsigned int target_seq;
 148 };
 149
 150 /* valid_vblank_list and valid_wait_list should be protected by valid_list_lock because
 151  * tdm_vblank can be used in multi-thread.
 152  */
 153 static pthread_mutex_t valid_list_lock;
 154 static struct list_head valid_vblank_list;
 155 static struct list_head valid_wait_list;
 156 static unsigned int vblank_list_inited;
 157 static unsigned int vblank_global_fps;
 158 static double stamp = 0;
 159
 160 static tdm_error _tdm_vblank_cb_vblank_SW(void *user_data);
 161 static tdm_error _tdm_vblank_wait_SW(tdm_vblank_wait_info *wait_info);
 162 static void _tdm_vblank_cb_vblank_HW(tdm_output *output, unsigned int sequence,
 163                                                                          unsigned int tv_sec, unsigned int tv_usec,
 164                                                                          void *user_data);
 165
 166 #if 0
 167 static void
 168 _print_list(struct list_head *list)
 169 {
 170         tdm_vblank_wait_info *w = NULL;
 171
 172         LIST_FOR_EACH_ENTRY(w, list, link) {
 173                 printf(" %d", w->interval);
 174         }
 175         printf("\n");
 176 }
 177 #endif
 178
 179 static void
 180 _tdm_vblank_valid_list_add(struct list_head *valid_link, struct list_head *valid_list)
 181 {
 182         pthread_mutex_lock(&valid_list_lock);
 183         LIST_ADDTAIL(valid_link, valid_list);
 184         pthread_mutex_unlock(&valid_list_lock);
 185 }
 186
 187 static void
 188 _tdm_vblank_valid_list_del(struct list_head *valid_link)
 189 {
 190         pthread_mutex_lock(&valid_list_lock);
 191         LIST_DEL(valid_link);
 192         pthread_mutex_unlock(&valid_list_lock);
 193 }
 194
 195 static inline tdm_private_vblank*
 196 _tdm_vblank_find(double vblank_stamp)
 197 {
 198         tdm_private_vblank *v = NULL;
 199
 200         if (!vblank_stamp)
 201                 return 0;
 202
 203         pthread_mutex_lock(&valid_list_lock);
 204         LIST_FOR_EACH_ENTRY(v, &valid_vblank_list, valid_link) {
 205                 if (v->stamp == vblank_stamp) {
 206                         pthread_mutex_unlock(&valid_list_lock);
 207                         return v;
 208                 }
 209         }
 210         pthread_mutex_unlock(&valid_list_lock);
 211
 212         return 0;
 213 }
 214
 215 static inline unsigned int
 216 _tdm_vblank_check_valid_wait(tdm_vblank_wait_info *wait_info)
 217 {
 218         tdm_vblank_wait_info *w = NULL;
 219
 220         if (!wait_info)
 221                 return 0;
 222
 223         pthread_mutex_lock(&valid_list_lock);
 224         LIST_FOR_EACH_ENTRY(w, &valid_wait_list, valid_link) {
 225                 if (w == wait_info) {
 226                         pthread_mutex_unlock(&valid_list_lock);
 227                         return 1;
 228                 }
 229         }
 230         pthread_mutex_unlock(&valid_list_lock);
 231
 232         return 0;
 233 }
 234
 235 static inline unsigned int
 236 _tdm_vblank_find_wait(tdm_vblank_wait_info *wait_info, struct list_head *list)
 237 {
 238         tdm_vblank_wait_info *w = NULL;
 239
 240         if (!wait_info)
 241                 return 0;
 242
 243         LIST_FOR_EACH_ENTRY(w, list, link) {
 244                 if (w->stamp == wait_info->stamp)
 245                         return 1;
 246         }
 247
 248         return 0;
 249 }
 250
 251 static inline void
 252 _tdm_vblank_insert_wait(tdm_vblank_wait_info *wait_info, struct list_head *list)
 253 {
 254         tdm_vblank_wait_info *w = NULL;
 255         tdm_vblank_wait_info *found = NULL;
 256
 257         if (LIST_IS_EMPTY(list)) {
 258                 LIST_ADDTAIL(&wait_info->link, list);
 259                 return;
 260         }
 261
 262         LIST_FOR_EACH_ENTRY(w, list, link) {
 263                 if (wait_info->type == VBLANK_TYPE_SW) {
 264                         if (wait_info->target_time == 0)
 265                                 TDM_NEVER_GET_HERE();
 266                         if (w->target_time <= wait_info->target_time) {
 267                                 found = w;
 268                                 continue;
 269                         }
 270                 } else {
 271                         if (w->interval <= wait_info->interval) {
 272                                 found = w;
 273                                 continue;
 274                         }
 275                 }
 276         }
 277
 278         if (found)
 279                 LIST_ADD(&wait_info->link, &found->link);
 280         else
 281                 LIST_ADDTAIL(&wait_info->link, list->next);
 282 }
 283
 284 static void
 285 _tdm_vblank_change_to_SW(tdm_private_vblank *private_vblank)
 286 {
 287         tdm_vblank_wait_info *w = NULL, *ww = NULL;
 288
 289         LIST_FOR_EACH_ENTRY_SAFE(w, ww, &private_vblank->HW_wait_list, link) {
 290                 LIST_DEL(&w->link);
 291
 292                 tdm_display_lock(private_vblank->dpy);
 293                 tdm_output_remove_vblank_handler_internal(private_vblank->output, _tdm_vblank_cb_vblank_HW, w);
 294                 tdm_display_unlock(private_vblank->dpy);
 295
 296                 w->type = VBLANK_TYPE_SW_FAKE;
 297                 _tdm_vblank_wait_SW(w);
 298         }
 299 }
 300
 301 static void
 302 _tdm_vblank_free_HW_wait(tdm_private_vblank *private_vblank, tdm_error error, unsigned int call_cb)
 303 {
 304         tdm_vblank_wait_info *w = NULL, *ww = NULL;
 305
 306         LIST_FOR_EACH_ENTRY_SAFE(w, ww, &private_vblank->HW_wait_list, link) {
 307                 LIST_DEL(&w->link);
 308                 _tdm_vblank_valid_list_del(&w->valid_link);
 309
 310                 tdm_display_lock(private_vblank->dpy);
 311                 tdm_output_remove_vblank_handler_internal(private_vblank->output, _tdm_vblank_cb_vblank_HW, w);
 312                 tdm_display_unlock(private_vblank->dpy);
 313
 314                 VDB("wait(%p) last(%.6f) sequence(%u) done (error:%d, call_cb:%u)",
 315                         w, 0, w->target_seq, error, call_cb);
 316
 317                 if (call_cb && w->func)
 318                         w->func(private_vblank, error, 0, 0, 0, w->user_data);
 319
 320                 free(w);
 321         }
 322 }
 323
 324 static void
 325 _tdm_vblank_update_output_info(tdm_private_vblank *private_vblank)
 326 {
 327         tdm_output *output = private_vblank->output;
 328         tdm_output_conn_status connection = TDM_OUTPUT_CONN_STATUS_DISCONNECTED;
 329         unsigned int vrefresh = 0;
 330         tdm_error ret;
 331
 332         ret = tdm_output_get_conn_status(output, &connection);
 333         TDM_WARNING_IF_FAIL(ret == TDM_ERROR_NONE);
 334
 335         if (connection != TDM_OUTPUT_CONN_STATUS_DISCONNECTED) {
 336                 const tdm_output_mode *mode = NULL;
 337                 tdm_output_get_mode(output, &mode);
 338                 if (mode)
 339                         vrefresh = mode->vrefresh;
 340                 else
 341                         VWR("mode not setted!!!");
 342         }
 343
 344         if (vrefresh == 0) {
 345                 VWR("vrefresh can't be zero !!!");
 346                 vrefresh = TDM_VBLANK_DEFAULT_VREFRESH;
 347         }
 348
 349         private_vblank->connection = connection;
 350         private_vblank->vrefresh = vrefresh;
 351         private_vblank->HW_vblank_gap = 1.0 / private_vblank->vrefresh;
 352
 353         if (private_vblank->fps_changeable)
 354                 private_vblank->fps = vrefresh;
 355
 356         VIN("connection(%d) vrefresh(%d) fps(%d) fps_changeable(%d)",
 357                 private_vblank->connection,
 358                 private_vblank->vrefresh, private_vblank->fps, private_vblank->fps_changeable);
 359 }
 360
 361 static void
 362 _tdm_vblank_cb_output_change(tdm_output *output, tdm_output_change_type type,
 363                                                          tdm_value value, void *user_data)
 364 {
 365         tdm_private_vblank *private_vblank = user_data;
 366
 367         TDM_RETURN_IF_FAIL(private_vblank != NULL);
 368
 369         switch (type) {
 370         case TDM_OUTPUT_CHANGE_DPMS:
 371                 VIN("dpms %s", tdm_dpms_str(value.u32));
 372                 private_vblank->check_HW_or_SW = 1;
 373                 if (value.u32 != TDM_OUTPUT_DPMS_ON) {
 374                         if (private_vblank->enable_fake)
 375                                 _tdm_vblank_change_to_SW(private_vblank);
 376                         else
 377                                 _tdm_vblank_free_HW_wait(private_vblank, TDM_ERROR_DPMS_OFF, 1);
 378                 }
 379                 break;
 380         case TDM_OUTPUT_CHANGE_CONNECTION:
 381                 if (private_vblank->connection == value.u32)
 382                         break;
 383                 VIN("output %s", tdm_status_str(value.u32));
 384                 _tdm_vblank_update_output_info(private_vblank);
 385                 private_vblank->check_HW_or_SW = 1;
 386                 if (private_vblank->connection == TDM_OUTPUT_CONN_STATUS_DISCONNECTED) {
 387                         if (private_vblank->enable_fake)
 388                                 _tdm_vblank_change_to_SW(private_vblank);
 389                         else
 390                                 _tdm_vblank_free_HW_wait(private_vblank, TDM_ERROR_OUTPUT_DISCONNECTED, 1);
 391                 }
 392                 break;
 393         default:
 394                 break;
 395         }
 396 }
 397
 398 EXTERN tdm_error
 399 tdm_vblank_set_client_vblank_fps(unsigned int pid, const char *name, unsigned int fps)
 400 {
 401         tdm_private_vblank *v = NULL;
 402
 403         TDM_RETURN_VAL_IF_FAIL(pid > 0, TDM_ERROR_INVALID_PARAMETER);
 404         TDM_RETURN_VAL_IF_FAIL(fps > 0, TDM_ERROR_INVALID_PARAMETER);
 405
 406         TDM_INFO("pid: %u, name: %s, fps: %d", pid, name, fps);
 407
 408         pthread_mutex_lock(&valid_list_lock);
 409         LIST_FOR_EACH_ENTRY(v, &valid_vblank_list, valid_link) {
 410                 struct wl_client *client;
 411                 pid_t client_pid = 0;
 412
 413                 if (!v->resource)
 414                         continue;
 415
 416                 client = wl_resource_get_client(v->resource);
 417                 if (!client)
 418                         continue;
 419
 420                 wl_client_get_credentials(client, &client_pid, NULL, NULL);
 421
 422                 if (client_pid != pid)
 423                         continue;
 424
 425                 if (name && strncmp(name, TDM_VBLANK_DEFAULT_NAME, TDM_NAME_LEN)) {
 426                         if (strncmp(v->name, name, TDM_NAME_LEN))
 427                                 continue;
 428                 }
 429
 430                 tdm_vblank_set_fps(v, fps);
 431
 432                 TDM_INFO("(pid:%u) '%s' fps changed: %d", pid, v->name, fps);
 433         }
 434         pthread_mutex_unlock(&valid_list_lock);
 435
 436         return TDM_ERROR_NONE;
 437 }
 438
 439 EXTERN tdm_error
 440 tdm_vblank_enable_global_fps(unsigned int enable, unsigned int fps)
 441 {
 442         tdm_private_vblank *v = NULL;
 443
 444         if (enable)
 445                 TDM_RETURN_VAL_IF_FAIL(fps > 0, TDM_ERROR_INVALID_PARAMETER);
 446
 447         TDM_INFO("global fps: %s fps(%d)", (enable) ? "enabled" : "disabled", fps);
 448
 449         pthread_mutex_lock(&valid_list_lock);
 450
 451         vblank_global_fps = (enable) ? fps : 0;
 452
 453         LIST_FOR_EACH_ENTRY(v, &valid_vblank_list, valid_link) {
 454                 /* skip if vblank is created in server side */
 455                 if (!v->resource)
 456                         continue;
 457
 458                 v->check_HW_or_SW = 1;
 459         }
 460         pthread_mutex_unlock(&valid_list_lock);
 461
 462         return TDM_ERROR_NONE;
 463 }
 464
 465 EXTERN tdm_vblank *
 466 tdm_vblank_create(tdm_display *dpy, tdm_output *output, tdm_error *error)
 467 {
 468         tdm_private_vblank *private_vblank;
 469         tdm_error ret;
 470
 471         TDM_RETURN_VAL_IF_FAIL_WITH_ERROR(dpy != NULL, TDM_ERROR_INVALID_PARAMETER, NULL);
 472         TDM_RETURN_VAL_IF_FAIL_WITH_ERROR(output != NULL, TDM_ERROR_INVALID_PARAMETER, NULL);
 473
 474         if (error)
 475                 *error = TDM_ERROR_NONE;
 476
 477         if (!vblank_list_inited) {
 478                 if (pthread_mutex_init(&valid_list_lock, NULL)) {
 479                         TDM_ERR("mutex init failed: %m");
 480                         if (error)
 481                                 *error = TDM_ERROR_OPERATION_FAILED;
 482                         return NULL;
 483                 }
 484                 LIST_INITHEAD(&valid_vblank_list);
 485                 LIST_INITHEAD(&valid_wait_list);
 486                 vblank_list_inited = 1;
 487         }
 488
 489         private_vblank = calloc(1, sizeof * private_vblank);
 490         if (!private_vblank) {
 491                 if (error)
 492                         *error = TDM_ERROR_OUT_OF_MEMORY;
 493                 VER("alloc failed");
 494                 return NULL;
 495         }
 496
 497         tdm_output_add_change_handler(output, _tdm_vblank_cb_output_change, private_vblank);
 498
 499         private_vblank->stamp = ++stamp;
 500         private_vblank->owner_tid = syscall(SYS_gettid);
 501         private_vblank->dpy = dpy;
 502         private_vblank->output = output;
 503         private_vblank->check_HW_or_SW = 1;
 504         private_vblank->fps_changeable = 1;
 505         private_vblank->last_interval = -1;
 506
 507         _tdm_vblank_update_output_info(private_vblank);
 508
 509         strncpy(private_vblank->name, TDM_VBLANK_DEFAULT_NAME, TDM_NAME_LEN - 1);
 510         private_vblank->name[TDM_NAME_LEN - 1] = '\0';
 511
 512         LIST_INITHEAD(&private_vblank->HW_wait_list);
 513         LIST_INITHEAD(&private_vblank->SW_wait_list);
 514
 515         _tdm_vblank_valid_list_add(&private_vblank->valid_link, &valid_vblank_list);
 516
 517         VIN("created. vrefresh(%d) connection(%d)",
 518                 private_vblank->vrefresh, private_vblank->connection);
 519
 520         return (tdm_vblank *)private_vblank;
 521 }
 522
 523 EXTERN void
 524 tdm_vblank_destroy(tdm_vblank *vblank)
 525 {
 526         tdm_private_vblank *private_vblank = vblank;
 527         tdm_vblank_wait_info *w = NULL, *ww = NULL;
 528
 529         if (!private_vblank)
 530                 return;
 531
 532         _tdm_vblank_valid_list_del(&private_vblank->valid_link);
 533
 534         if (private_vblank->SW_timer) {
 535                 tdm_display_lock(private_vblank->dpy);
 536                 tdm_event_loop_source_remove(private_vblank->SW_timer);
 537                 tdm_display_unlock(private_vblank->dpy);
 538         }
 539
 540         tdm_output_remove_change_handler(private_vblank->output,
 541                                                                          _tdm_vblank_cb_output_change, private_vblank);
 542
 543         _tdm_vblank_free_HW_wait(private_vblank, 0, 0);
 544
 545         LIST_FOR_EACH_ENTRY_SAFE(w, ww, &private_vblank->SW_wait_list, link) {
 546                 LIST_DEL(&w->link);
 547                 _tdm_vblank_valid_list_del(&w->valid_link);
 548                 free(w);
 549         }
 550
 551         VIN("destroyed");
 552
 553         free(private_vblank);
 554 }
 555
 556 EXTERN tdm_error
 557 tdm_vblank_set_name(tdm_vblank *vblank, const char *name)
 558 {
 559         tdm_private_vblank *private_vblank = vblank;
 560
 561         TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
 562
 563         if (!name)
 564                 name = TDM_VBLANK_DEFAULT_NAME;
 565
 566         strncpy(private_vblank->name, name, TDM_NAME_LEN - 1);
 567         private_vblank->name[TDM_NAME_LEN - 1] = '\0';
 568
 569         VIN("name(%s)", name);
 570
 571         return TDM_ERROR_NONE;
 572 }
 573
 574 EXTERN tdm_error
 575 tdm_vblank_get_name(tdm_vblank *vblank, const char **name)
 576 {
 577         tdm_private_vblank *private_vblank = vblank;
 578
 579         TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
 580         TDM_RETURN_VAL_IF_FAIL(name != NULL, TDM_ERROR_INVALID_PARAMETER);
 581
 582         *name = (const char*)private_vblank->name;
 583
 584         return TDM_ERROR_NONE;
 585 }
 586
 587 EXTERN tdm_error
 588 tdm_vblank_set_fps(tdm_vblank *vblank, unsigned int fps)
 589 {
 590         tdm_private_vblank *private_vblank = vblank;
 591
 592         TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
 593         TDM_RETURN_VAL_IF_FAIL(fps > 0, TDM_ERROR_INVALID_PARAMETER);
 594
 595         if (private_vblank->fps != fps || private_vblank->fps_changeable)
 596                 VIN("fps(%d) fps_changeable(0)", fps);
 597
 598         private_vblank->fps_changeable = 0;
 599
 600         if (private_vblank->fps == fps)
 601                 return TDM_ERROR_NONE;
 602
 603         private_vblank->fps = fps;
 604         private_vblank->check_HW_or_SW = 1;
 605
 606         return TDM_ERROR_NONE;
 607 }
 608
 609 EXTERN tdm_error
 610 tdm_vblank_get_fps(tdm_vblank *vblank, unsigned int *fps)
 611 {
 612         tdm_private_vblank *private_vblank = vblank;
 613
 614         TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
 615         TDM_RETURN_VAL_IF_FAIL(fps != NULL, TDM_ERROR_INVALID_PARAMETER);
 616
 617         *fps = private_vblank->fps;
 618
 619         return TDM_ERROR_NONE;
 620 }
 621
 622 EXTERN tdm_error
 623 tdm_vblank_ignore_global_fps(tdm_vblank *vblank, unsigned int ignore)
 624 {
 625         tdm_private_vblank *private_vblank = vblank;
 626
 627         TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
 628
 629         if (private_vblank->ignore_global_fps == ignore)
 630                 return TDM_ERROR_NONE;
 631
 632         private_vblank->ignore_global_fps = ignore;
 633         private_vblank->check_HW_or_SW = 1;
 634
 635         VIN("ignore_global_fps(%d)", private_vblank->ignore_global_fps);
 636
 637         return TDM_ERROR_NONE;
 638 }
 639
 640 EXTERN tdm_error
 641 tdm_vblank_set_offset(tdm_vblank *vblank, int offset)
 642 {
 643         tdm_private_vblank *private_vblank = vblank;
 644
 645         TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
 646
 647         if (private_vblank->offset == offset)
 648                 return TDM_ERROR_NONE;
 649
 650         private_vblank->offset = offset;
 651         private_vblank->check_HW_or_SW = 1;
 652
 653         VIN("offset(%d)", private_vblank->offset);
 654
 655         return TDM_ERROR_NONE;
 656 }
 657
 658 EXTERN tdm_error
 659 tdm_vblank_get_offset(tdm_vblank *vblank, int *offset)
 660 {
 661         tdm_private_vblank *private_vblank = vblank;
 662
 663         TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
 664         TDM_RETURN_VAL_IF_FAIL(offset != NULL, TDM_ERROR_INVALID_PARAMETER);
 665
 666         *offset = private_vblank->offset;
 667
 668         return TDM_ERROR_NONE;
 669 }
 670
 671 EXTERN tdm_error
 672 tdm_vblank_set_enable_fake(tdm_vblank *vblank, unsigned int enable_fake)
 673 {
 674         tdm_private_vblank *private_vblank = vblank;
 675
 676         TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
 677
 678         if (private_vblank->enable_fake == enable_fake)
 679                 return TDM_ERROR_NONE;
 680
 681         private_vblank->enable_fake = enable_fake;
 682
 683         VIN("enable_fake(%d)", private_vblank->enable_fake);
 684
 685         return TDM_ERROR_NONE;
 686 }
 687
 688 EXTERN tdm_error
 689 tdm_vblank_get_enable_fake(tdm_vblank *vblank, unsigned int *enable_fake)
 690 {
 691         tdm_private_vblank *private_vblank = vblank;
 692
 693         TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
 694         TDM_RETURN_VAL_IF_FAIL(enable_fake != NULL, TDM_ERROR_INVALID_PARAMETER);
 695
 696         *enable_fake = private_vblank->enable_fake;
 697
 698         return TDM_ERROR_NONE;
 699 }
 700
 701 static tdm_error
 702 _tdm_vblank_sw_timer_update(tdm_private_vblank *private_vblank)
 703 {
 704         tdm_vblank_wait_info *first_wait_info = NULL;
 705         double curr, target;
 706         int ms_delay;
 707         tdm_error ret;
 708
 709         if (LIST_IS_EMPTY(&private_vblank->SW_wait_list)) {
 710                 VER("no wait_info");
 711                 return TDM_ERROR_OPERATION_FAILED;
 712         }
 713
 714         first_wait_info = container_of(private_vblank->SW_wait_list.next, first_wait_info, link);
 715         curr = tdm_helper_get_time();
 716         target = first_wait_info->target_time;
 717
 718         /* ms_delay should be more that 1 */
 719         if (target < curr)
 720                 ms_delay = 1;
 721         else
 722                 ms_delay = ceil((target - curr) * 1000.0);
 723
 724         if (ms_delay < 1)
 725                 ms_delay = 1;
 726
 727         if (ms_delay > 5000)
 728                 VER("wait(%p) curr(%.6f) target(%.6f) ms_delay(%d)", first_wait_info, curr, target, ms_delay);
 729         else
 730                 VDB("wait(%p) curr(%.6f) target(%.6f) ms_delay(%d)", first_wait_info, curr, target, ms_delay);
 731
 732         tdm_display_lock(private_vblank->dpy);
 733
 734         if (!private_vblank->SW_timer) {
 735                 private_vblank->SW_timer =
 736                         tdm_event_loop_add_timer_handler(private_vblank->dpy,
 737                                                                                          _tdm_vblank_cb_vblank_SW,
 738                                                                                          private_vblank,
 739                                                                                          &ret);
 740                 if (!private_vblank->SW_timer) {
 741                         tdm_display_unlock(private_vblank->dpy);
 742                         VER("couldn't add timer");
 743                         return ret;
 744                 }
 745                 VIN("Create SW timer");
 746         }
 747
 748         private_vblank->last_interval = ms_delay;
 749
 750         ret = tdm_event_loop_source_timer_update(private_vblank->SW_timer, ms_delay);
 751         if (ret != TDM_ERROR_NONE) {
 752                 tdm_display_unlock(private_vblank->dpy);
 753                 VER("couldn't update timer");
 754                 return ret;
 755         }
 756
 757         tdm_display_unlock(private_vblank->dpy);
 758
 759         return TDM_ERROR_NONE;
 760 }
 761
 762 static void
 763 _tdm_vblank_cb_vblank_HW(tdm_output *output, unsigned int sequence,
 764                                                  unsigned int tv_sec, unsigned int tv_usec,
 765                                                  void *user_data)
 766 {
 767         tdm_vblank_wait_info *wait_info = user_data;
 768         tdm_private_vblank *private_vblank;
 769
 770         if (!_tdm_vblank_check_valid_wait(wait_info)) {
 771                 TDM_DBG("can't find wait(%p) from valid_wait_list", wait_info);
 772                 return;
 773         }
 774
 775         private_vblank = wait_info->private_vblank;
 776         TDM_RETURN_IF_FAIL(private_vblank != NULL);
 777
 778         if (!_tdm_vblank_find_wait(wait_info, &private_vblank->HW_wait_list)) {
 779                 VDB("can't find wait(%p)", wait_info);
 780                 return;
 781         }
 782
 783         if (wait_info->type == VBLANK_TYPE_HW_SW) {
 784                 tdm_error ret;
 785
 786                 LIST_DEL(&wait_info->link);
 787
 788                 /* kernel sends the wrong time of first vblank event. and the time of
 789                  * second vblank is correct.
 790                  */
 791                 wait_info->target_time = TDM_TIME(tv_sec, tv_usec);
 792                 wait_info->target_time += (((double)private_vblank->offset) / 1000.0);
 793
 794                 _tdm_vblank_insert_wait(wait_info, &private_vblank->SW_wait_list);
 795
 796                 ret = _tdm_vblank_sw_timer_update(private_vblank);
 797
 798                 /* wait_info will be freed in _tdm_vblank_cb_vblank_SW() */
 799                 if (ret == TDM_ERROR_NONE) {
 800                         VDB("wait(%p) SW timer", wait_info);
 801                         return;
 802                 }
 803
 804                 VWR("couldn't update sw timer");
 805         }
 806
 807         LIST_DEL(&wait_info->link);
 808         _tdm_vblank_valid_list_del(&wait_info->valid_link);
 809
 810         /* tv_sec & tv_usec shouldn't be zero. But sometimes they are zero in some hardware.
 811          * We need to prohibit that last_time becomes zero because "last_time == 0" means
 812          * that a tdm_vblank object is just created and doesn't have the first vblank event.
 813          * If last_time becomes 0, it would make issue.
 814          */
 815         if (tv_sec == 0 && tv_usec == 0) {
 816                 double curr = tdm_helper_get_time();
 817                 tv_sec = TDM_TIME_SEC(curr);
 818                 tv_usec = TDM_TIME_USEC(curr);
 819         }
 820
 821         private_vblank->last_seq = wait_info->target_seq;
 822         private_vblank->last_time = TDM_TIME(tv_sec, tv_usec);
 823
 824         VDB("wait(%p) last(%.6f) sequence(%u) done", wait_info, private_vblank->last_time, wait_info->target_seq);
 825
 826         if (wait_info->func)
 827                 wait_info->func(private_vblank, TDM_ERROR_NONE, wait_info->target_seq,
 828                                                 tv_sec, tv_usec, wait_info->user_data);
 829
 830         free(wait_info);
 831 }
 832
 833 static tdm_error
 834 _tdm_vblank_wait_HW(tdm_vblank_wait_info *wait_info)
 835 {
 836         tdm_private_vblank *private_vblank = wait_info->private_vblank;
 837         int hw_interval;
 838         tdm_error ret;
 839
 840         if (private_vblank->last_type != VBLANK_EVENT_TYPE_HW) {
 841                 VIN("Use HW vblank");
 842                 private_vblank->last_type = VBLANK_EVENT_TYPE_HW;
 843         }
 844
 845         _tdm_vblank_insert_wait(wait_info, &private_vblank->HW_wait_list);
 846
 847         hw_interval = wait_info->interval * private_vblank->quotient;
 848
 849         if (private_vblank->last_time == 0) {
 850                 /* SW vblank starts from now. SW vblank doesn't need to be aligned with HW vblank. */
 851                 private_vblank->last_seq = 0;
 852                 private_vblank->last_time = tdm_helper_get_time();
 853
 854                 /* +1 ms to call the handler ASAP at the first. no matter for SW timer. */
 855                 wait_info->target_seq = 1;
 856
 857                 VDB("wait(%p) last(%.6f) hw_itvl(%d) targ_seq(%u)",
 858                         wait_info, private_vblank->last_time, hw_interval, wait_info->target_seq);
 859         } else {
 860                 double last, prev, req, curr, target;
 861                 unsigned int skip;
 862
 863                 last = private_vblank->last_time;
 864                 req = wait_info->req_time;
 865
 866                 /* make sure that req time is bigger than last. */
 867                 if (req < last)
 868                         req = last;
 869
 870                 skip = (unsigned int)((req - last) / private_vblank->vblank_gap + TDM_TIME_MARGIN);
 871                 prev = last + private_vblank->vblank_gap * skip;
 872
 873                 curr = tdm_helper_get_time();
 874                 target = last;
 875                 while (target < curr)
 876                         target += (private_vblank->vblank_gap * wait_info->interval);
 877
 878                 hw_interval = (unsigned int)((target - curr) / private_vblank->HW_vblank_gap + TDM_TIME_MARGIN) + 1;
 879
 880                 wait_info->target_seq = private_vblank->last_seq;
 881                 wait_info->target_seq += (unsigned int)((target - last) / private_vblank->vblank_gap + TDM_TIME_MARGIN);
 882
 883                 if (hw_interval > 300)
 884                         VER("wait(%p) last(%.6f) req(%.6f) prev(%.6f) curr(%.6f) targ(%.6f,%.6f) skip(%u) hw_itvl(%d) targ_seq(%u)",
 885                                 wait_info, last, req - last, prev - last, curr - last, target, target - last,
 886                                 skip, hw_interval, wait_info->target_seq);
 887                 else
 888                         VDB("wait(%p) last(%.6f) req(%.6f) prev(%.6f) curr(%.6f) targ(%.6f,%.6f) skip(%u) hw_itvl(%d) targ_seq(%u)",
 889                                 wait_info, last, req - last, prev - last, curr - last, target, target - last,
 890                                 skip, hw_interval, wait_info->target_seq);
 891         }
 892
 893         private_vblank->last_interval = hw_interval;
 894
 895         if (private_vblank->add_front)
 896                 ret = tdm_output_wait_vblank_add_front(private_vblank->output, hw_interval, 0,
 897                                                                                            _tdm_vblank_cb_vblank_HW, wait_info);
 898         else
 899                 ret = tdm_output_wait_vblank(private_vblank->output, hw_interval, 0,
 900                                                                          _tdm_vblank_cb_vblank_HW, wait_info);
 901
 902         if (ret != TDM_ERROR_NONE) {
 903                 LIST_DEL(&wait_info->link);
 904                 return ret;
 905         }
 906
 907         VDB("wait(%p) waiting", wait_info);
 908
 909         return TDM_ERROR_NONE;
 910 }
 911
 912 static tdm_error
 913 _tdm_vblank_cb_vblank_SW(void *user_data)
 914 {
 915         tdm_private_vblank *private_vblank = user_data;
 916
 917         TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_OPERATION_FAILED);
 918
 919         return tdm_vblank_cb_vblank_SW(private_vblank, 0);
 920 }
 921
 922 INTERN tdm_error
 923 tdm_vblank_cb_vblank_SW(tdm_vblank *vblank, double vblank_stamp)
 924 {
 925         tdm_private_vblank *private_vblank;
 926         tdm_vblank_wait_info *first_wait_info = NULL, *w = NULL, *ww = NULL;
 927
 928         TDM_RETURN_VAL_IF_FAIL(vblank || vblank_stamp > 0, TDM_ERROR_INVALID_PARAMETER);
 929
 930         if (vblank)
 931                 private_vblank = vblank;
 932         else {
 933                 private_vblank = _tdm_vblank_find(vblank_stamp);
 934                 if (!private_vblank) {
 935                         TDM_DBG("can't find vblank(%.0f) from valid_list", vblank_stamp);
 936                         return TDM_ERROR_NONE;
 937                 }
 938         }
 939
 940         if (private_vblank->owner_tid != syscall(SYS_gettid)) {
 941                 tdm_thread_cb_vblank_sw vblank_sw;
 942                 tdm_private_display *private_display = private_vblank->dpy;
 943                 tdm_error ret;
 944
 945                 vblank_sw.base.type = TDM_THREAD_CB_VBLANK_SW;
 946                 vblank_sw.base.length = sizeof vblank_sw;
 947                 vblank_sw.vblank_stamp = private_vblank->stamp;
 948
 949                 ret = tdm_thread_send_cb(private_display->private_loop, &vblank_sw.base);
 950                 TDM_WARNING_IF_FAIL(ret == TDM_ERROR_NONE);
 951
 952                 return TDM_ERROR_NONE;
 953         }
 954
 955         if (LIST_IS_EMPTY(&private_vblank->SW_wait_list)) {
 956                 VER("no wait_info");
 957                 return TDM_ERROR_OPERATION_FAILED;
 958         }
 959
 960         first_wait_info = container_of(private_vblank->SW_wait_list.next, first_wait_info, link);
 961         TDM_RETURN_VAL_IF_FAIL(first_wait_info != NULL, TDM_ERROR_OPERATION_FAILED);
 962
 963         if (private_vblank->last_seq >= first_wait_info->target_seq)
 964                 TDM_ERR("last_seq(%u) target_seq(%u)", private_vblank->last_seq, first_wait_info->target_seq);
 965
 966         private_vblank->last_seq = first_wait_info->target_seq;
 967         private_vblank->last_time = first_wait_info->target_time;
 968
 969         VDB("wait(%p) last(%.6f) sequence(%u) done", first_wait_info, private_vblank->last_time, first_wait_info->target_seq);
 970
 971         LIST_FOR_EACH_ENTRY_SAFE(w, ww, &private_vblank->SW_wait_list, link) {
 972                 if (w->target_time != first_wait_info->target_time)
 973                         break;
 974
 975                 LIST_DEL(&w->link);
 976                 _tdm_vblank_valid_list_del(&w->valid_link);
 977
 978                 if (w->func) {
 979                         tdm_display_unlock(private_vblank->dpy);
 980                         w->func(private_vblank, TDM_ERROR_NONE, w->target_seq,
 981                                         TDM_TIME_SEC(w->target_time), TDM_TIME_USEC(w->target_time),
 982                                         w->user_data);
 983                         tdm_display_lock(private_vblank->dpy);
 984                 }
 985
 986                 free(w);
 987         }
 988
 989         return TDM_ERROR_NONE;
 990 }
 991
 992 static tdm_error
 993 _tdm_vblank_wait_SW(tdm_vblank_wait_info *wait_info)
 994 {
 995         tdm_private_vblank *private_vblank = wait_info->private_vblank;
 996         tdm_error ret;
 997
 998         if (private_vblank->last_type != VBLANK_EVENT_TYPE_SW) {
 999                 VIN("Use SW vblank");
1000                 private_vblank->last_type = VBLANK_EVENT_TYPE_SW;
1001         }
1002
1003         if (private_vblank->last_time == 0) {
1004                 /* SW vblank starts from now. SW vblank doesn't need to be aligned with HW vblank. */
1005                 private_vblank->last_seq = 0;
1006                 private_vblank->last_time = tdm_helper_get_time();
1007
1008                 /* +1 ms to call the handler ASAP at the first. no matter for SW timer. */
1009                 wait_info->target_seq = 1;
1010                 wait_info->target_time = private_vblank->last_time + 0.001;
1011
1012                 VDB("wait(%p) last(%.6f) target(%.6f) target sequence(%u)",
1013                         wait_info, private_vblank->last_time, wait_info->target_time, wait_info->target_seq);
1014         } else {
1015                 double last, prev, req, curr, target;
1016                 unsigned int skip;
1017
1018                 last = private_vblank->last_time;
1019                 req = wait_info->req_time;
1020
1021                 /* make sure that req time is bigger than last. */
1022                 if (req < last)
1023                         req = last;
1024
1025                 skip = (unsigned int)((req - last) / private_vblank->vblank_gap + TDM_TIME_MARGIN);
1026                 prev = last + private_vblank->vblank_gap * skip;
1027
1028                 curr = tdm_helper_get_time();
1029                 target = prev + private_vblank->vblank_gap * wait_info->interval;
1030
1031                 while (target < curr)
1032                         target += private_vblank->vblank_gap;
1033
1034                 wait_info->target_seq = private_vblank->last_seq;
1035                 wait_info->target_seq += (unsigned int)((target - last) / private_vblank->vblank_gap + TDM_TIME_MARGIN);
1036
1037                 wait_info->target_time = target;
1038
1039                 VDB("wait(%p) last(%.6f) req(%.6f) prev(%.6f) curr(%.6f) targ(%.6f,%.6f) skip(%u) targ_seq(%u)",
1040                         wait_info, last, req - last, prev - last, curr - last,
1041                         target, target - last, skip, wait_info->target_seq);
1042         }
1043
1044         _tdm_vblank_insert_wait(wait_info, &private_vblank->SW_wait_list);
1045
1046         ret = _tdm_vblank_sw_timer_update(private_vblank);
1047         if (ret != TDM_ERROR_NONE) {
1048                 LIST_DEL(&wait_info->link);
1049                 VER("couldn't update sw timer");
1050                 return ret;
1051         }
1052
1053         return TDM_ERROR_NONE;
1054 }
1055
1056 EXTERN tdm_error
1057 tdm_vblank_wait(tdm_vblank *vblank, unsigned int req_sec, unsigned int req_usec,
1058                                 unsigned int interval, tdm_vblank_handler func, void *user_data)
1059 {
1060         tdm_private_vblank *private_vblank = vblank;
1061         tdm_vblank_wait_info *wait_info;
1062         tdm_output_dpms dpms = TDM_OUTPUT_DPMS_OFF;
1063         unsigned int fps;
1064         tdm_error ret;
1065
1066         TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
1067         TDM_RETURN_VAL_IF_FAIL(func != NULL, TDM_ERROR_INVALID_PARAMETER);
1068
1069         if (private_vblank->owner_tid != syscall(SYS_gettid)) {
1070                 TDM_ERR("SHOULD be called in the owner thread(%d)", (int)private_vblank->owner_tid);
1071                 return TDM_ERROR_BAD_REQUEST;
1072         }
1073
1074         tdm_output_get_dpms(private_vblank->output, &dpms);
1075
1076         if (!private_vblank->enable_fake) {
1077                 if (private_vblank->connection == TDM_OUTPUT_CONN_STATUS_DISCONNECTED) {
1078                         VER("can't wait a vblank: output disconnected");
1079                         return TDM_ERROR_OUTPUT_DISCONNECTED;
1080                 }
1081                 if (dpms != TDM_OUTPUT_DPMS_ON) {
1082                         VER("can't wait a vblank: DPMS off");
1083                         return TDM_ERROR_DPMS_OFF;
1084                 }
1085         }
1086
1087         wait_info = calloc(1, sizeof * wait_info);
1088         if (!wait_info) {
1089                 VER("alloc failed");
1090                 return TDM_ERROR_OUT_OF_MEMORY;
1091         }
1092
1093         /* set request time to current time if 0. This function seems to be called in server side. */
1094         if (req_sec == 0 && req_usec == 0) {
1095                 double curr = tdm_helper_get_time();
1096                 req_sec = TDM_TIME_SEC(curr);
1097                 req_usec = TDM_TIME_USEC(curr);
1098         }
1099
1100         LIST_INITHEAD(&wait_info->link);
1101
1102         _tdm_vblank_valid_list_add(&wait_info->valid_link, &valid_wait_list);
1103
1104         wait_info->stamp = ++stamp;
1105         wait_info->req_time = TDM_TIME(req_sec, req_usec);
1106         wait_info->interval = interval;
1107         wait_info->func = func;
1108         wait_info->user_data = user_data;
1109         wait_info->private_vblank = private_vblank;
1110
1111         if (private_vblank->ignore_global_fps ||
1112                 vblank_global_fps == 0 ||
1113                 private_vblank->fps < vblank_global_fps)
1114                 fps = private_vblank->fps;
1115         else
1116                 fps = vblank_global_fps;
1117
1118         if (private_vblank->check_HW_or_SW) {
1119                 private_vblank->check_HW_or_SW = 0;
1120                 private_vblank->vblank_gap = 1.0 / fps;
1121                 private_vblank->quotient = private_vblank->vrefresh / fps;
1122         }
1123
1124         /* 1) if fps != factor of vrefresh, SW timer
1125          * 2) if fps == factor of vrefresh && dpms == off, SW timer (Fake HW vblank)
1126          * 2) if fps == factor of vrefresh && dpms == on && offset == 0, HW vblank
1127          * 3) if fps == factor of vrefresh && dpms == on && offset != 0, HW vblank + SW timer
1128          * In case of 1), we really don't need to align with HW vblank.
1129          */
1130         if (private_vblank->vrefresh % fps)
1131                 wait_info->type = VBLANK_TYPE_SW;
1132         else if (dpms == TDM_OUTPUT_DPMS_OFF ||
1133                          private_vblank->connection == TDM_OUTPUT_CONN_STATUS_DISCONNECTED)
1134                 wait_info->type = VBLANK_TYPE_SW_FAKE;
1135         else if (private_vblank->offset == 0)
1136                 wait_info->type = VBLANK_TYPE_HW;
1137         else
1138                 wait_info->type = VBLANK_TYPE_HW_SW;
1139
1140         if (wait_info->type == VBLANK_TYPE_SW || wait_info->type == VBLANK_TYPE_SW_FAKE)
1141                 ret = _tdm_vblank_wait_SW(wait_info);
1142         else {
1143                 ret = _tdm_vblank_wait_HW(wait_info);
1144                 if (ret == TDM_ERROR_OUTPUT_DISCONNECTED || ret == TDM_ERROR_DPMS_OFF)
1145                         ret = _tdm_vblank_wait_SW(wait_info);
1146         }
1147
1148         if (ret != TDM_ERROR_NONE) {
1149                 LIST_DEL(&wait_info->link);
1150                 _tdm_vblank_valid_list_del(&wait_info->valid_link);
1151
1152                 tdm_display_lock(private_vblank->dpy);
1153                 tdm_output_remove_vblank_handler_internal(private_vblank->output, _tdm_vblank_cb_vblank_HW, wait_info);
1154                 tdm_display_unlock(private_vblank->dpy);
1155
1156                 free(wait_info);
1157                 return ret;
1158         }
1159
1160         return TDM_ERROR_NONE;
1161 }
1162
1163 EXTERN tdm_error
1164 tdm_vblank_wait_seq(tdm_vblank *vblank, unsigned int req_sec, unsigned int req_usec,
1165                                         unsigned int sequence, tdm_vblank_handler func, void *user_data)
1166 {
1167         tdm_private_vblank *private_vblank = vblank;
1168         unsigned int interval;
1169
1170         TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
1171         TDM_RETURN_VAL_IF_FAIL(func != NULL, TDM_ERROR_INVALID_PARAMETER);
1172
1173         /* if the sequence of vblank reaches the max value, sequence can be 0. */
1174
1175         if (private_vblank->last_seq == 0) {
1176                 TDM_WRN("can't calculate interval with sequence(%u)", sequence);
1177                 interval = 1;
1178         } else if (sequence > private_vblank->last_seq ||
1179                            TDM_VBLANK_SEQ_REACHED_MAX(sequence, private_vblank->last_seq)) {
1180                 double last, curr, seq_target;
1181
1182                 last = private_vblank->last_time;
1183                 curr = tdm_helper_get_time();
1184                 seq_target = last + private_vblank->vblank_gap * (sequence - private_vblank->last_seq);
1185
1186                 /* If target is old or too close(1ms) to current, we call the handler immediately.
1187                  * 2ms? it seems too much.
1188                  */
1189                 if (seq_target < curr) {
1190                         func(vblank, TDM_ERROR_NONE, sequence,
1191                                  TDM_TIME_SEC(seq_target), TDM_TIME_USEC(seq_target),
1192                                  user_data);
1193                         return TDM_ERROR_NONE;
1194                 } else if ((seq_target - curr) < 0.001) {  /* 1ms */
1195                         func(vblank, TDM_ERROR_NONE, sequence,
1196                                  TDM_TIME_SEC(curr), TDM_TIME_USEC(curr),
1197                                  user_data);
1198                         return TDM_ERROR_NONE;
1199                 }
1200
1201                 interval = (unsigned int)((seq_target - curr) / private_vblank->vblank_gap + TDM_TIME_MARGIN) + 1;
1202         } else {
1203                 /* this seems error. But we handle this like normal to avoid the unexpected error in cliend side */
1204                 TDM_WRN("sequence(%u) should be over the last sequence(%u)", sequence, private_vblank->last_seq);
1205                 func(vblank, TDM_ERROR_NONE, private_vblank->last_seq,
1206                          TDM_TIME_SEC(private_vblank->last_time), TDM_TIME_USEC(private_vblank->last_time),
1207                          user_data);
1208                 return TDM_ERROR_NONE;
1209         }
1210
1211         return tdm_vblank_wait(vblank, req_sec, req_usec, interval, func, user_data);
1212 }
1213
1214 INTERN tdm_error
1215 tdm_vblank_set_add_front(tdm_vblank *vblank, unsigned int add_front)
1216 {
1217         tdm_private_vblank *private_vblank = vblank;
1218
1219         TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
1220
1221         TDM_RETURN_VAL_IF_FAIL(TDM_MUTEX_IS_LOCKED(), TDM_ERROR_OPERATION_FAILED);
1222
1223         if (private_vblank->add_front == add_front)
1224                 return TDM_ERROR_NONE;
1225
1226         private_vblank->add_front = add_front;
1227
1228         return TDM_ERROR_NONE;
1229 }
1230
1231 INTERN tdm_error
1232 tdm_vblank_set_resource(tdm_vblank *vblank, struct wl_resource *resource)
1233 {
1234         tdm_private_vblank *private_vblank = vblank;
1235
1236         TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
1237         TDM_RETURN_VAL_IF_FAIL(private_vblank->resource == NULL, TDM_ERROR_OPERATION_FAILED);
1238
1239         private_vblank->resource = resource;
1240
1241         return TDM_ERROR_NONE;
1242 }
1243
1244 INTERN double
1245 tdm_vblank_get_stamp(tdm_vblank *vblank)
1246 {
1247         tdm_private_vblank *private_vblank = vblank;
1248
1249         TDM_RETURN_VAL_IF_FAIL(private_vblank != NULL, TDM_ERROR_INVALID_PARAMETER);
1250
1251         return private_vblank->stamp;
1252 }
1253
1254 static unsigned int
1255 _tdm_vblank_get_waiting_count(tdm_private_vblank *private_vblank)
1256 {
1257         tdm_vblank_wait_info *wait_info = NULL;
1258         unsigned int count = 0;
1259
1260         LIST_FOR_EACH_ENTRY(wait_info, &private_vblank->HW_wait_list, link) {
1261                 count++;
1262         }
1263
1264         LIST_FOR_EACH_ENTRY(wait_info, &private_vblank->SW_wait_list, link) {
1265                 count++;
1266         }
1267
1268         return count;
1269 }
1270
1271 INTERN void
1272 tdm_vblank_get_vblank_list_information(tdm_display *dpy, char *reply, int *len)
1273 {
1274         tdm_private_vblank *v = NULL;
1275         tdm_output_dpms dpms = TDM_OUTPUT_DPMS_OFF;
1276         tdm_output *output = tdm_display_get_output(dpy, 0, NULL);
1277
1278         if (output)
1279                 tdm_output_get_dpms(output, &dpms);
1280
1281         TDM_SNPRINTF(reply, len, "[Client Vblank List]\n");
1282         TDM_SNPRINTF(reply, len, "* DPMS: %s\n", tdm_dpms_str(dpms));
1283         TDM_SNPRINTF(reply, len, "* global fps: %u\n", vblank_global_fps);
1284         TDM_SNPRINTF(reply, len, "----------------------------------------------------------------------------------\n");
1285         TDM_SNPRINTF(reply, len, "Name                 Type Wait Interval Sequence Fps Ignore Offset Fake Process\n");
1286         TDM_SNPRINTF(reply, len, "----------------------------------------------------------------------------------\n");
1287
1288         pthread_mutex_lock(&valid_list_lock);
1289         LIST_FOR_EACH_ENTRY(v, &valid_vblank_list, valid_link) {
1290                 const char *proc_name = NULL;
1291                 pid_t pid = 0;
1292                 unsigned int count;
1293
1294                 if (v->resource) {
1295                         struct wl_client *client = wl_resource_get_client(v->resource);
1296                         if (client) {
1297                                 wl_client_get_credentials(client, &pid, NULL, NULL);
1298                                 proc_name = tdm_server_get_client_name(pid);
1299                         }
1300                 }
1301
1302                 count = _tdm_vblank_get_waiting_count(v);
1303
1304                 TDM_SNPRINTF(reply, len, "%-8s(%p) ", v->name, v);
1305                 TDM_SNPRINTF(reply, len, "%-4s ", (v->last_type == VBLANK_EVENT_TYPE_HW) ? "HW" : "SW");
1306                 TDM_SNPRINTF(reply, len, "%-4s ", (count > 0) ? "O" : " ");
1307                 TDM_SNPRINTF(reply, len, "%-8d ", v->last_interval);
1308                 TDM_SNPRINTF(reply, len, "%-8u ", v->last_seq);
1309                 TDM_SNPRINTF(reply, len, "%-3u ", v->fps);
1310                 TDM_SNPRINTF(reply, len, "%-6u ", v->ignore_global_fps);
1311                 TDM_SNPRINTF(reply, len, "%-6d ", v->offset);
1312                 TDM_SNPRINTF(reply, len, "%-4u ", v->enable_fake);
1313                 TDM_SNPRINTF(reply, len, "%s(pid:%d)\n", (proc_name) ? proc_name : "Unknown", pid);
1314         }
1315         pthread_mutex_unlock(&valid_list_lock);
1316
1317         TDM_SNPRINTF(reply, len, "\n");
1318 }
1319