2 * Copyright (C) STMicroelectronics SA 2014
3 * Authors: Benjamin Gaignard <benjamin.gaignard@st.com>
4 * Fabien Dessenne <fabien.dessenne@st.com>
5 * for STMicroelectronics.
6 * License terms: GNU General Public License (GPL), version 2
10 #include <drm/drm_fb_cma_helper.h>
11 #include <drm/drm_gem_cma_helper.h>
13 #include "sti_compositor.h"
15 #include "sti_plane.h"
17 /* (Background) < GDP0 < GDP1 < HQVDP0 < GDP2 < GDP3 < (ForeGround) */
18 enum sti_plane_desc sti_plane_default_zorder
[] = {
26 const char *sti_plane_to_str(struct sti_plane
*plane
)
28 switch (plane
->desc
) {
42 return "<UNKNOWN PLANE>";
46 #define STI_FPS_INTERVAL_MS 3000
48 static int sti_plane_timespec_ms_diff(struct timespec lhs
, struct timespec rhs
)
50 struct timespec tmp_ts
= timespec_sub(lhs
, rhs
);
51 u64 tmp_ns
= (u64
)timespec_to_ns(&tmp_ts
);
53 do_div(tmp_ns
, NSEC_PER_MSEC
);
58 void sti_plane_update_fps(struct sti_plane
*plane
,
63 struct sti_fps_info
*fps
;
64 int fpks
, fipks
, ms_since_last
, num_frames
, num_fields
;
66 getrawmonotonic(&now
);
68 /* Compute number of frame updates */
69 fps
= &plane
->fps_info
;
72 fps
->curr_field_counter
++;
74 /* do not perform fps calcul if new_frame is false */
78 fps
->curr_frame_counter
++;
79 ms_since_last
= sti_plane_timespec_ms_diff(now
, fps
->last_timestamp
);
80 num_frames
= fps
->curr_frame_counter
- fps
->last_frame_counter
;
82 if (num_frames
<= 0 || ms_since_last
< STI_FPS_INTERVAL_MS
)
85 fps
->last_timestamp
= now
;
86 fps
->last_frame_counter
= fps
->curr_frame_counter
;
87 fpks
= (num_frames
* 1000000) / ms_since_last
;
88 snprintf(plane
->fps_info
.fps_str
, FPS_LENGTH
, "%-6s @ %d.%.3d fps",
89 sti_plane_to_str(plane
), fpks
/ 1000, fpks
% 1000);
91 if (fps
->curr_field_counter
) {
92 /* Compute number of field updates */
93 num_fields
= fps
->curr_field_counter
- fps
->last_field_counter
;
94 fps
->last_field_counter
= fps
->curr_field_counter
;
95 fipks
= (num_fields
* 1000000) / ms_since_last
;
96 snprintf(plane
->fps_info
.fips_str
,
97 FPS_LENGTH
, " - %d.%.3d field/sec",
98 fipks
/ 1000, fipks
% 1000);
100 plane
->fps_info
.fips_str
[0] = '\0';
105 plane
->fps_info
.fps_str
,
106 plane
->fps_info
.fips_str
);
109 static void sti_plane_destroy(struct drm_plane
*drm_plane
)
111 DRM_DEBUG_DRIVER("\n");
113 drm_plane_helper_disable(drm_plane
);
114 drm_plane_cleanup(drm_plane
);
117 static int sti_plane_set_property(struct drm_plane
*drm_plane
,
118 struct drm_property
*property
,
121 struct drm_device
*dev
= drm_plane
->dev
;
122 struct sti_private
*private = dev
->dev_private
;
123 struct sti_plane
*plane
= to_sti_plane(drm_plane
);
125 DRM_DEBUG_DRIVER("\n");
127 if (property
== private->plane_zorder_property
) {
135 static void sti_plane_attach_zorder_property(struct drm_plane
*drm_plane
)
137 struct drm_device
*dev
= drm_plane
->dev
;
138 struct sti_private
*private = dev
->dev_private
;
139 struct sti_plane
*plane
= to_sti_plane(drm_plane
);
140 struct drm_property
*prop
;
142 prop
= private->plane_zorder_property
;
144 prop
= drm_property_create_range(dev
, 0, "zpos", 1,
145 GAM_MIXER_NB_DEPTH_LEVEL
);
149 private->plane_zorder_property
= prop
;
152 drm_object_attach_property(&drm_plane
->base
, prop
, plane
->zorder
);
155 void sti_plane_init_property(struct sti_plane
*plane
,
156 enum drm_plane_type type
)
160 for (i
= 0; i
< ARRAY_SIZE(sti_plane_default_zorder
); i
++)
161 if (sti_plane_default_zorder
[i
] == plane
->desc
)
164 plane
->zorder
= i
+ 1;
166 if (type
== DRM_PLANE_TYPE_OVERLAY
)
167 sti_plane_attach_zorder_property(&plane
->drm_plane
);
169 DRM_DEBUG_DRIVER("drm plane:%d mapped to %s with zorder:%d\n",
170 plane
->drm_plane
.base
.id
,
171 sti_plane_to_str(plane
), plane
->zorder
);
174 struct drm_plane_funcs sti_plane_helpers_funcs
= {
175 .update_plane
= drm_atomic_helper_update_plane
,
176 .disable_plane
= drm_atomic_helper_disable_plane
,
177 .destroy
= sti_plane_destroy
,
178 .set_property
= sti_plane_set_property
,
179 .reset
= drm_atomic_helper_plane_reset
,
180 .atomic_duplicate_state
= drm_atomic_helper_plane_duplicate_state
,
181 .atomic_destroy_state
= drm_atomic_helper_plane_destroy_state
,