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