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}