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
20const 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
42void 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
103static 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
116static 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
132void 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