1/*
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
7 */
8
9#include <drm/drmP.h>
10#include <drm/drm_gem_cma_helper.h>
11#include <drm/drm_fb_cma_helper.h>
12
13#include "sti_compositor.h"
14#include "sti_cursor.h"
15#include "sti_gdp.h"
16#include "sti_hqvdp.h"
17#include "sti_layer.h"
18#include "sti_vid.h"
19
20const char *sti_layer_to_str(struct sti_layer *layer)
21{
22	switch (layer->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_VID_0:
32		return "VID0";
33	case STI_VID_1:
34		return "VID1";
35	case STI_CURSOR:
36		return "CURSOR";
37	case STI_HQVDP_0:
38		return "HQVDP0";
39	default:
40		return "<UNKNOWN LAYER>";
41	}
42}
43EXPORT_SYMBOL(sti_layer_to_str);
44
45struct sti_layer *sti_layer_create(struct device *dev, int desc,
46				   void __iomem *baseaddr)
47{
48
49	struct sti_layer *layer = NULL;
50
51	switch (desc & STI_LAYER_TYPE_MASK) {
52	case STI_GDP:
53		layer = sti_gdp_create(dev, desc);
54		break;
55	case STI_VID:
56		layer = sti_vid_create(dev);
57		break;
58	case STI_CUR:
59		layer = sti_cursor_create(dev);
60		break;
61	case STI_VDP:
62		layer = sti_hqvdp_create(dev);
63		break;
64	}
65
66	if (!layer) {
67		DRM_ERROR("Failed to create layer\n");
68		return NULL;
69	}
70
71	layer->desc = desc;
72	layer->dev = dev;
73	layer->regs = baseaddr;
74
75	layer->ops->init(layer);
76
77	DRM_DEBUG_DRIVER("%s created\n", sti_layer_to_str(layer));
78
79	return layer;
80}
81EXPORT_SYMBOL(sti_layer_create);
82
83int sti_layer_prepare(struct sti_layer *layer,
84		      struct drm_crtc *crtc,
85		      struct drm_framebuffer *fb,
86		      struct drm_display_mode *mode, int mixer_id,
87		      int dest_x, int dest_y, int dest_w, int dest_h,
88		      int src_x, int src_y, int src_w, int src_h)
89{
90	int ret;
91	unsigned int i;
92	struct drm_gem_cma_object *cma_obj;
93
94	if (!layer || !fb || !mode) {
95		DRM_ERROR("Null fb, layer or mode\n");
96		return 1;
97	}
98
99	cma_obj = drm_fb_cma_get_gem_obj(fb, 0);
100	if (!cma_obj) {
101		DRM_ERROR("Can't get CMA GEM object for fb\n");
102		return 1;
103	}
104
105	layer->crtc = crtc;
106	layer->fb = fb;
107	layer->mode = mode;
108	layer->mixer_id = mixer_id;
109	layer->dst_x = dest_x;
110	layer->dst_y = dest_y;
111	layer->dst_w = clamp_val(dest_w, 0, mode->crtc_hdisplay - dest_x);
112	layer->dst_h = clamp_val(dest_h, 0, mode->crtc_vdisplay - dest_y);
113	layer->src_x = src_x;
114	layer->src_y = src_y;
115	layer->src_w = src_w;
116	layer->src_h = src_h;
117	layer->format = fb->pixel_format;
118	layer->vaddr = cma_obj->vaddr;
119	layer->paddr = cma_obj->paddr;
120	for (i = 0; i < 4; i++) {
121		layer->pitches[i] = fb->pitches[i];
122		layer->offsets[i] = fb->offsets[i];
123	}
124
125	DRM_DEBUG_DRIVER("%s is associated with mixer_id %d\n",
126			 sti_layer_to_str(layer),
127			 layer->mixer_id);
128	DRM_DEBUG_DRIVER("%s dst=(%dx%d)@(%d,%d) - src=(%dx%d)@(%d,%d)\n",
129			 sti_layer_to_str(layer),
130			 layer->dst_w, layer->dst_h, layer->dst_x, layer->dst_y,
131			 layer->src_w, layer->src_h, layer->src_x,
132			 layer->src_y);
133
134	DRM_DEBUG_DRIVER("drm FB:%d format:%.4s phys@:0x%lx\n", fb->base.id,
135			 (char *)&layer->format, (unsigned long)layer->paddr);
136
137	if (!layer->ops->prepare)
138		goto err_no_prepare;
139
140	ret = layer->ops->prepare(layer, !layer->enabled);
141	if (!ret)
142		layer->enabled = true;
143
144	return ret;
145
146err_no_prepare:
147	DRM_ERROR("Cannot prepare\n");
148	return 1;
149}
150
151int sti_layer_commit(struct sti_layer *layer)
152{
153	if (!layer)
154		return 1;
155
156	if (!layer->ops->commit)
157		goto err_no_commit;
158
159	return layer->ops->commit(layer);
160
161err_no_commit:
162	DRM_ERROR("Cannot commit\n");
163	return 1;
164}
165
166int sti_layer_disable(struct sti_layer *layer)
167{
168	int ret;
169
170	DRM_DEBUG_DRIVER("%s\n", sti_layer_to_str(layer));
171	if (!layer)
172		return 1;
173
174	if (!layer->enabled)
175		return 0;
176
177	if (!layer->ops->disable)
178		goto err_no_disable;
179
180	ret = layer->ops->disable(layer);
181	if (!ret)
182		layer->enabled = false;
183	else
184		DRM_ERROR("Disable failed\n");
185
186	return ret;
187
188err_no_disable:
189	DRM_ERROR("Cannot disable\n");
190	return 1;
191}
192
193const uint32_t *sti_layer_get_formats(struct sti_layer *layer)
194{
195	if (!layer)
196		return NULL;
197
198	if (!layer->ops->get_formats)
199		return NULL;
200
201	return layer->ops->get_formats(layer);
202}
203
204unsigned int sti_layer_get_nb_formats(struct sti_layer *layer)
205{
206	if (!layer)
207		return 0;
208
209	if (!layer->ops->get_nb_formats)
210		return 0;
211
212	return layer->ops->get_nb_formats(layer);
213}
214