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_XRGB8888, 138 }; 139 140 static struct sun4i_layer *sun4i_layer_init_one(struct drm_device *drm, 141 struct sun4i_backend *backend, 142 enum drm_plane_type type) 143 { 144 struct sun4i_layer *layer; 145 int ret; 146 147 layer = devm_kzalloc(drm->dev, sizeof(*layer), GFP_KERNEL); 148 if (!layer) 149 return ERR_PTR(-ENOMEM); 150 151 /* possible crtcs are set later */ 152 ret = drm_universal_plane_init(drm, &layer->plane, 0, 153 &sun4i_backend_layer_funcs, 154 sun4i_backend_layer_formats, 155 ARRAY_SIZE(sun4i_backend_layer_formats), 156 NULL, type, NULL); 157 if (ret) { 158 dev_err(drm->dev, "Couldn't initialize layer\n"); 159 return ERR_PTR(ret); 160 } 161 162 drm_plane_helper_add(&layer->plane, 163 &sun4i_backend_layer_helper_funcs); 164 layer->backend = backend; 165 166 drm_plane_create_zpos_property(&layer->plane, 0, 0, 167 SUN4I_BACKEND_NUM_LAYERS - 1); 168 169 return layer; 170 } 171 172 struct drm_plane **sun4i_layers_init(struct drm_device *drm, 173 struct sunxi_engine *engine) 174 { 175 struct drm_plane **planes; 176 struct sun4i_backend *backend = engine_to_sun4i_backend(engine); 177 int i; 178 179 /* We need to have a sentinel at the need, hence the overallocation */ 180 planes = devm_kcalloc(drm->dev, SUN4I_BACKEND_NUM_LAYERS + 1, 181 sizeof(*planes), GFP_KERNEL); 182 if (!planes) 183 return ERR_PTR(-ENOMEM); 184 185 for (i = 0; i < SUN4I_BACKEND_NUM_LAYERS; i++) { 186 enum drm_plane_type type = i ? DRM_PLANE_TYPE_OVERLAY : DRM_PLANE_TYPE_PRIMARY; 187 struct sun4i_layer *layer; 188 189 layer = sun4i_layer_init_one(drm, backend, type); 190 if (IS_ERR(layer)) { 191 dev_err(drm->dev, "Couldn't initialize %s plane\n", 192 i ? "overlay" : "primary"); 193 return ERR_CAST(layer); 194 }; 195 196 layer->id = i; 197 planes[i] = &layer->plane; 198 }; 199 200 return planes; 201 } 202