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