drivers/gpu/drm/sti/sti_plane.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright (C) STMicroelectronics SA 2014
   4  * Authors: Benjamin Gaignard <benjamin.gaignard@st.com>
   5  *          Fabien Dessenne <fabien.dessenne@st.com>
   6  *          for STMicroelectronics.
   7  */
   8
   9 #include <linux/types.h>
  10
  11 #include <drm/drm_fb_cma_helper.h>
  12 #include <drm/drm_fourcc.h>
  13 #include <drm/drm_gem_cma_helper.h>
  14
  15 #include "sti_compositor.h"
  16 #include "sti_drv.h"
  17 #include "sti_plane.h"
  18
  19 const char *sti_plane_to_str(struct sti_plane *plane)
  20 {
  21         switch (plane->desc) {
  22         case STI_GDP_0:
  23                 return "GDP0";
  24         case STI_GDP_1:
  25                 return "GDP1";
  26         case STI_GDP_2:
  27                 return "GDP2";
  28         case STI_GDP_3:
  29                 return "GDP3";
  30         case STI_HQVDP_0:
  31                 return "HQVDP0";
  32         case STI_CURSOR:
  33                 return "CURSOR";
  34         default:
  35                 return "<UNKNOWN PLANE>";
  36         }
  37 }
  38
  39 #define STI_FPS_INTERVAL_MS     3000
  40
  41 void sti_plane_update_fps(struct sti_plane *plane,
  42                           bool new_frame,
  43                           bool new_field)
  44 {
  45         struct drm_plane_state *state = plane->drm_plane.state;
  46         ktime_t now;
  47         struct sti_fps_info *fps;
  48         int fpks, fipks, ms_since_last, num_frames, num_fields;
  49
  50         now = ktime_get();
  51
  52         /* Compute number of frame updates */
  53         fps = &plane->fps_info;
  54
  55         if (new_field)
  56                 fps->curr_field_counter++;
  57
  58         /* do not perform fps calcul if new_frame is false */
  59         if (!new_frame)
  60                 return;
  61
  62         fps->curr_frame_counter++;
  63         ms_since_last = ktime_to_ms(ktime_sub(now, fps->last_timestamp));
  64         num_frames = fps->curr_frame_counter - fps->last_frame_counter;
  65
  66         if (num_frames <= 0  || ms_since_last < STI_FPS_INTERVAL_MS)
  67                 return;
  68
  69         fps->last_timestamp = now;
  70         fps->last_frame_counter = fps->curr_frame_counter;
  71
  72         if (state->fb) {
  73                 fpks = (num_frames * 1000000) / ms_since_last;
  74                 snprintf(plane->fps_info.fps_str, FPS_LENGTH,
  75                          "%-8s %4dx%-4d %.4s @ %3d.%-3.3d fps (%s)",
  76                          plane->drm_plane.name,
  77                          state->fb->width,
  78                          state->fb->height,
  79                          (char *)&state->fb->format->format,
  80                          fpks / 1000, fpks % 1000,
  81                          sti_plane_to_str(plane));
  82         }
  83
  84         if (fps->curr_field_counter) {
  85                 /* Compute number of field updates */
  86                 num_fields = fps->curr_field_counter - fps->last_field_counter;
  87                 fps->last_field_counter = fps->curr_field_counter;
  88                 fipks = (num_fields * 1000000) / ms_since_last;
  89                 snprintf(plane->fps_info.fips_str,
  90                          FPS_LENGTH, " - %3d.%-3.3d field/sec",
  91                          fipks / 1000, fipks % 1000);
  92         } else {
  93                 plane->fps_info.fips_str[0] = '\0';
  94         }
  95
  96         if (fps->output)
  97                 DRM_INFO("%s%s\n",
  98                          plane->fps_info.fps_str,
  99                          plane->fps_info.fips_str);
 100 }
 101
 102 static int sti_plane_get_default_zpos(enum drm_plane_type type)
 103 {
 104         switch (type) {
 105         case DRM_PLANE_TYPE_PRIMARY:
 106                 return 0;
 107         case DRM_PLANE_TYPE_OVERLAY:
 108                 return 1;
 109         case DRM_PLANE_TYPE_CURSOR:
 110                 return 7;
 111         }
 112         return 0;
 113 }
 114
 115 void sti_plane_reset(struct drm_plane *plane)
 116 {
 117         drm_atomic_helper_plane_reset(plane);
 118         plane->state->zpos = sti_plane_get_default_zpos(plane->type);
 119 }
 120
 121 static void sti_plane_attach_zorder_property(struct drm_plane *drm_plane,
 122                                              enum drm_plane_type type)
 123 {
 124         int zpos = sti_plane_get_default_zpos(type);
 125
 126         switch (type) {
 127         case DRM_PLANE_TYPE_PRIMARY:
 128         case DRM_PLANE_TYPE_OVERLAY:
 129                 drm_plane_create_zpos_property(drm_plane, zpos, 0, 6);
 130                 break;
 131         case DRM_PLANE_TYPE_CURSOR:
 132                 drm_plane_create_zpos_immutable_property(drm_plane, zpos);
 133                 break;
 134         }
 135 }
 136
 137 void sti_plane_init_property(struct sti_plane *plane,
 138                              enum drm_plane_type type)
 139 {
 140         sti_plane_attach_zorder_property(&plane->drm_plane, type);
 141
 142         DRM_DEBUG_DRIVER("drm plane:%d mapped to %s\n",
 143                          plane->drm_plane.base.id, sti_plane_to_str(plane));
 144 }