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
 19const 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
 41void 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
102static 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
115void 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
121static 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
137void 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}