1 /* 2 * Copyright (C) 2015 Free Electrons 3 * Copyright (C) 2015 NextThing Co 4 * 5 * Maxime Ripard <maxime.ripard@free-electrons.com> 6 * 7 * This program is free software; you can redistribute it and/or 8 * modify it under the terms of the GNU General Public License as 9 * published by the Free Software Foundation; either version 2 of 10 * the License, or (at your option) any later version. 11 */ 12 13 #include <drm/drm_atomic_helper.h> 14 #include <drm/drm_plane_helper.h> 15 #include <drm/drmP.h> 16 17 #include "sun4i_backend.h" 18 #include "sun4i_frontend.h" 19 #include "sun4i_layer.h" 20 #include "sunxi_engine.h" 21 22 static void sun4i_backend_layer_reset(struct drm_plane *plane) 23 { 24 struct sun4i_layer *layer = plane_to_sun4i_layer(plane); 25 struct sun4i_layer_state *state; 26 27 if (plane->state) { 28 state = state_to_sun4i_layer_state(plane->state); 29 30 __drm_atomic_helper_plane_destroy_state(&state->state); 31 32 kfree(state); 33 plane->state = NULL; 34 } 35 36 state = kzalloc(sizeof(*state), GFP_KERNEL); 37 if (state) { 38 plane->state = &state->state; 39 plane->state->plane = plane; 40 plane->state->zpos = layer->id; 41 } 42 } 43 44 static struct drm_plane_state * 45 sun4i_backend_layer_duplicate_state(struct drm_plane *plane) 46 { 47 struct sun4i_layer_state *orig = state_to_sun4i_layer_state(plane->state); 48 struct sun4i_layer_state *copy; 49 50 copy = kzalloc(sizeof(*copy), GFP_KERNEL); 51 if (!copy) 52 return NULL; 53 54 __drm_atomic_helper_plane_duplicate_state(plane, ©->state); 55 copy->uses_frontend = orig->uses_frontend; 56 57 return ©->state; 58 } 59 60 static void sun4i_backend_layer_destroy_state(struct drm_plane *plane, 61 struct drm_plane_state *state) 62 { 63 struct sun4i_layer_state *s_state = state_to_sun4i_layer_state(state); 64 65 __drm_atomic_helper_plane_destroy_state(state); 66 67 kfree(s_state); 68 } 69 70 static void sun4i_backend_layer_atomic_disable(struct drm_plane *plane, 71 struct drm_plane_state *old_state) 72 { 73 struct sun4i_layer_state *layer_state = state_to_sun4i_layer_state(old_state); 74 struct sun4i_layer *layer = plane_to_sun4i_layer(plane); 75 struct sun4i_backend *backend = layer->backend; 76 77 sun4i_backend_layer_enable(backend, layer->id, false); 78 79 if (layer_state->uses_frontend) { 80 unsigned long flags; 81 82 spin_lock_irqsave(&backend->frontend_lock, flags); 83 backend->frontend_teardown = true; 84 spin_unlock_irqrestore(&backend->frontend_lock, flags); 85 } 86 } 87 88 static void sun4i_backend_layer_atomic_update(struct drm_plane *plane, 89 struct drm_plane_state *old_state) 90 { 91 struct sun4i_layer_state *layer_state = state_to_sun4i_layer_state(plane->state); 92 struct sun4i_layer *layer = plane_to_sun4i_layer(plane); 93 struct sun4i_backend *backend = layer->backend; 94 struct sun4i_frontend *frontend = backend->frontend; 95 96 if (layer_state->uses_frontend) { 97 sun4i_frontend_init(frontend); 98 sun4i_frontend_update_coord(frontend, plane); 99 sun4i_frontend_update_buffer(frontend, plane); 100 sun4i_frontend_update_formats(frontend, plane, 101 DRM_FORMAT_ARGB8888); 102 sun4i_backend_update_layer_frontend(backend, layer->id, 103 DRM_FORMAT_ARGB8888); 104 sun4i_frontend_enable(frontend); 105 } else { 106 sun4i_backend_update_layer_formats(backend, layer->id, plane); 107 sun4i_backend_update_layer_buffer(backend, layer->id, plane); 108 } 109 110 sun4i_backend_update_layer_coord(backend, layer->id, plane); 111 sun4i_backend_update_layer_zpos(backend, layer->id, plane); 112 sun4i_backend_layer_enable(backend, layer->id, true); 113 } 114 115 static const struct drm_plane_helper_funcs sun4i_backend_layer_helper_funcs = { 116 .atomic_disable = sun4i_backend_layer_atomic_disable, 117 .atomic_update = sun4i_backend_layer_atomic_update, 118 }; 119 120 static const struct drm_plane_funcs sun4i_backend_layer_funcs = { 121 .atomic_destroy_state = sun4i_backend_layer_destroy_state, 122 .atomic_duplicate_state = sun4i_backend_layer_duplicate_state, 123 .destroy = drm_plane_cleanup, 124 .disable_plane = drm_atomic_helper_disable_plane, 125 .reset = sun4i_backend_layer_reset, 126 .update_plane = drm_atomic_helper_update_plane, 127 }; 128 129 static const uint32_t sun4i_backend_layer_formats[] = { 130 DRM_FORMAT_ARGB8888, 131 DRM_FORMAT_ARGB4444, 132 DRM_FORMAT_ARGB1555, 133 DRM_FORMAT_RGBA5551, 134 DRM_FORMAT_RGBA4444, 135 DRM_FORMAT_RGB888, 136 DRM_FORMAT_RGB565, 137 DRM_FORMAT_UYVY, 138 DRM_FORMAT_VYUY, 139 DRM_FORMAT_XRGB8888, 140 DRM_FORMAT_YUYV, 141 DRM_FORMAT_YVYU, 142 }; 143 144 static struct sun4i_layer *sun4i_layer_init_one(struct drm_device *drm, 145 struct sun4i_backend *backend, 146 enum drm_plane_type type) 147 { 148 struct sun4i_layer *layer; 149 int ret; 150 151 layer = devm_kzalloc(drm->dev, sizeof(*layer), GFP_KERNEL); 152 if (!layer) 153 return ERR_PTR(-ENOMEM); 154 155 /* possible crtcs are set later */ 156 ret = drm_universal_plane_init(drm, &layer->plane, 0, 157 &sun4i_backend_layer_funcs, 158 sun4i_backend_layer_formats, 159 ARRAY_SIZE(sun4i_backend_layer_formats), 160 NULL, type, NULL); 161 if (ret) { 162 dev_err(drm->dev, "Couldn't initialize layer\n"); 163 return ERR_PTR(ret); 164 } 165 166 drm_plane_helper_add(&layer->plane, 167 &sun4i_backend_layer_helper_funcs); 168 layer->backend = backend; 169 170 drm_plane_create_zpos_property(&layer->plane, 0, 0, 171 SUN4I_BACKEND_NUM_LAYERS - 1); 172 173 return layer; 174 } 175 176 struct drm_plane **sun4i_layers_init(struct drm_device *drm, 177 struct sunxi_engine *engine) 178 { 179 struct drm_plane **planes; 180 struct sun4i_backend *backend = engine_to_sun4i_backend(engine); 181 int i; 182 183 /* We need to have a sentinel at the need, hence the overallocation */ 184 planes = devm_kcalloc(drm->dev, SUN4I_BACKEND_NUM_LAYERS + 1, 185 sizeof(*planes), GFP_KERNEL); 186 if (!planes) 187 return ERR_PTR(-ENOMEM); 188 189 for (i = 0; i < SUN4I_BACKEND_NUM_LAYERS; i++) { 190 enum drm_plane_type type = i ? DRM_PLANE_TYPE_OVERLAY : DRM_PLANE_TYPE_PRIMARY; 191 struct sun4i_layer *layer; 192 193 layer = sun4i_layer_init_one(drm, backend, type); 194 if (IS_ERR(layer)) { 195 dev_err(drm->dev, "Couldn't initialize %s plane\n", 196 i ? "overlay" : "primary"); 197 return ERR_CAST(layer); 198 }; 199 200 layer->id = i; 201 planes[i] = &layer->plane; 202 }; 203 204 return planes; 205 } 206