1219019Sgabor// SPDX-License-Identifier: GPL-2.0 2219019Sgabor/* 3219019Sgabor * R-Car Display Unit Writeback Support 4219019Sgabor * 5219019Sgabor * Copyright (C) 2019 Laurent Pinchart <laurent.pinchart@ideasonboard.com> 6219019Sgabor */ 7219019Sgabor 8219019Sgabor#include <drm/drm_atomic_helper.h> 9219019Sgabor#include <drm/drm_device.h> 10219019Sgabor#include <drm/drm_edid.h> 11219019Sgabor#include <drm/drm_fourcc.h> 12219019Sgabor#include <drm/drm_framebuffer.h> 13219019Sgabor#include <drm/drm_probe_helper.h> 14219019Sgabor#include <drm/drm_writeback.h> 15219019Sgabor 16219019Sgabor#include "rcar_du_crtc.h" 17219019Sgabor#include "rcar_du_drv.h" 18219019Sgabor#include "rcar_du_kms.h" 19219019Sgabor#include "rcar_du_writeback.h" 20219019Sgabor 21219019Sgabor/** 22219019Sgabor * struct rcar_du_wb_conn_state - Driver-specific writeback connector state 23219019Sgabor * @state: base DRM connector state 24219019Sgabor * @format: format of the writeback framebuffer 25219019Sgabor */ 26219019Sgaborstruct rcar_du_wb_conn_state { 27219019Sgabor struct drm_connector_state state; 28219019Sgabor const struct rcar_du_format_info *format; 29219019Sgabor}; 30219019Sgabor 31219019Sgabor#define to_rcar_wb_conn_state(s) \ 32219019Sgabor container_of(s, struct rcar_du_wb_conn_state, state) 33219019Sgabor 34219019Sgabor/** 35219019Sgabor * struct rcar_du_wb_job - Driver-private data for writeback jobs 36219019Sgabor * @sg_tables: scatter-gather tables for the framebuffer memory 37219019Sgabor */ 38219019Sgaborstruct rcar_du_wb_job { 39219019Sgabor struct sg_table sg_tables[3]; 40219019Sgabor}; 41219019Sgabor 42219019Sgaborstatic int rcar_du_wb_conn_get_modes(struct drm_connector *connector) 43219019Sgabor{ 44219019Sgabor struct drm_device *dev = connector->dev; 45219019Sgabor 46219019Sgabor return drm_add_modes_noedid(connector, dev->mode_config.max_width, 47219019Sgabor dev->mode_config.max_height); 48219019Sgabor} 49219019Sgabor 50219019Sgaborstatic int rcar_du_wb_prepare_job(struct drm_writeback_connector *connector, 51219019Sgabor struct drm_writeback_job *job) 52219019Sgabor{ 53219019Sgabor struct rcar_du_crtc *rcrtc = wb_to_rcar_crtc(connector); 54219019Sgabor struct rcar_du_wb_job *rjob; 55219019Sgabor int ret; 56219019Sgabor 57219019Sgabor if (!job->fb) 58219019Sgabor return 0; 59219019Sgabor 60219019Sgabor rjob = kzalloc(sizeof(*rjob), GFP_KERNEL); 61219019Sgabor if (!rjob) 62219019Sgabor return -ENOMEM; 63219019Sgabor 64219019Sgabor /* Map the framebuffer to the VSP. */ 65219019Sgabor ret = rcar_du_vsp_map_fb(rcrtc->vsp, job->fb, rjob->sg_tables); 66219019Sgabor if (ret < 0) { 67219019Sgabor kfree(rjob); 68219019Sgabor return ret; 69219019Sgabor } 70219019Sgabor 71219019Sgabor job->priv = rjob; 72219019Sgabor return 0; 73219019Sgabor} 74219019Sgabor 75219019Sgaborstatic void rcar_du_wb_cleanup_job(struct drm_writeback_connector *connector, 76219019Sgabor struct drm_writeback_job *job) 77219019Sgabor{ 78219019Sgabor struct rcar_du_crtc *rcrtc = wb_to_rcar_crtc(connector); 79219019Sgabor struct rcar_du_wb_job *rjob = job->priv; 80219019Sgabor 81219019Sgabor if (!job->fb) 82219019Sgabor return; 83219019Sgabor 84219019Sgabor rcar_du_vsp_unmap_fb(rcrtc->vsp, job->fb, rjob->sg_tables); 85219019Sgabor kfree(rjob); 86219019Sgabor} 87219019Sgabor 88219019Sgaborstatic const struct drm_connector_helper_funcs rcar_du_wb_conn_helper_funcs = { 89219019Sgabor .get_modes = rcar_du_wb_conn_get_modes, 90219019Sgabor .prepare_writeback_job = rcar_du_wb_prepare_job, 91219019Sgabor .cleanup_writeback_job = rcar_du_wb_cleanup_job, 92219019Sgabor}; 93219019Sgabor 94219019Sgaborstatic struct drm_connector_state * 95219019Sgaborrcar_du_wb_conn_duplicate_state(struct drm_connector *connector) 96219019Sgabor{ 97219019Sgabor struct rcar_du_wb_conn_state *copy; 98219019Sgabor 99219019Sgabor if (WARN_ON(!connector->state)) 100219019Sgabor return NULL; 101219019Sgabor 102219019Sgabor copy = kzalloc(sizeof(*copy), GFP_KERNEL); 103219019Sgabor if (!copy) 104219019Sgabor return NULL; 105219019Sgabor 106219019Sgabor __drm_atomic_helper_connector_duplicate_state(connector, ©->state); 107219019Sgabor 108219019Sgabor return ©->state; 109219019Sgabor} 110219019Sgabor 111219019Sgaborstatic void rcar_du_wb_conn_destroy_state(struct drm_connector *connector, 112219019Sgabor struct drm_connector_state *state) 113219019Sgabor{ 114219019Sgabor __drm_atomic_helper_connector_destroy_state(state); 115219019Sgabor kfree(to_rcar_wb_conn_state(state)); 116219019Sgabor} 117219019Sgabor 118219019Sgaborstatic void rcar_du_wb_conn_reset(struct drm_connector *connector) 119219019Sgabor{ 120219019Sgabor struct rcar_du_wb_conn_state *state; 121219019Sgabor 122219019Sgabor if (connector->state) { 123219019Sgabor rcar_du_wb_conn_destroy_state(connector, connector->state); 124219019Sgabor connector->state = NULL; 125219019Sgabor } 126219019Sgabor 127219019Sgabor state = kzalloc(sizeof(*state), GFP_KERNEL); 128219019Sgabor if (state == NULL) 129219019Sgabor return; 130219019Sgabor 131219019Sgabor __drm_atomic_helper_connector_reset(connector, &state->state); 132219019Sgabor} 133219019Sgabor 134219019Sgaborstatic const struct drm_connector_funcs rcar_du_wb_conn_funcs = { 135219019Sgabor .reset = rcar_du_wb_conn_reset, 136219019Sgabor .fill_modes = drm_helper_probe_single_connector_modes, 137219019Sgabor .destroy = drm_connector_cleanup, 138219019Sgabor .atomic_duplicate_state = rcar_du_wb_conn_duplicate_state, 139219019Sgabor .atomic_destroy_state = rcar_du_wb_conn_destroy_state, 140219019Sgabor}; 141219019Sgabor 142219019Sgaborstatic int rcar_du_wb_enc_atomic_check(struct drm_encoder *encoder, 143219019Sgabor struct drm_crtc_state *crtc_state, 144219019Sgabor struct drm_connector_state *conn_state) 145219019Sgabor{ 146219019Sgabor struct rcar_du_wb_conn_state *wb_state = 147219019Sgabor to_rcar_wb_conn_state(conn_state); 148219019Sgabor const struct drm_display_mode *mode = &crtc_state->mode; 149219019Sgabor struct drm_device *dev = encoder->dev; 150219019Sgabor struct drm_framebuffer *fb; 151219019Sgabor 152219019Sgabor if (!conn_state->writeback_job) 153219019Sgabor return 0; 154219019Sgabor 155219019Sgabor fb = conn_state->writeback_job->fb; 156219019Sgabor 157219019Sgabor /* 158219019Sgabor * Verify that the framebuffer format is supported and that its size 159219019Sgabor * matches the current mode. 160219019Sgabor */ 161219019Sgabor if (fb->width != mode->hdisplay || fb->height != mode->vdisplay) { 162219019Sgabor dev_dbg(dev->dev, "%s: invalid framebuffer size %ux%u\n", 163219019Sgabor __func__, fb->width, fb->height); 164219019Sgabor return -EINVAL; 165219019Sgabor } 166219019Sgabor 167219019Sgabor wb_state->format = rcar_du_format_info(fb->format->format); 168219019Sgabor if (wb_state->format == NULL) { 169219019Sgabor dev_dbg(dev->dev, "%s: unsupported format %p4cc\n", __func__, 170219019Sgabor &fb->format->format); 171219019Sgabor return -EINVAL; 172219019Sgabor } 173219019Sgabor 174219019Sgabor return 0; 175219019Sgabor} 176219019Sgabor 177219019Sgaborstatic const struct drm_encoder_helper_funcs rcar_du_wb_enc_helper_funcs = { 178219019Sgabor .atomic_check = rcar_du_wb_enc_atomic_check, 179219019Sgabor}; 180219019Sgabor 181219019Sgabor/* 182219019Sgabor * Only RGB formats are currently supported as the VSP outputs RGB to the DU 183219019Sgabor * and can't convert to YUV separately for writeback. 184219019Sgabor */ 185219019Sgaborstatic const u32 writeback_formats[] = { 186219019Sgabor DRM_FORMAT_RGB332, 187219019Sgabor DRM_FORMAT_ARGB4444, 188219019Sgabor DRM_FORMAT_XRGB4444, 189219019Sgabor DRM_FORMAT_ARGB1555, 190219019Sgabor DRM_FORMAT_XRGB1555, 191219019Sgabor DRM_FORMAT_RGB565, 192219019Sgabor DRM_FORMAT_BGR888, 193219019Sgabor DRM_FORMAT_RGB888, 194219019Sgabor DRM_FORMAT_BGRA8888, 195219019Sgabor DRM_FORMAT_BGRX8888, 196219019Sgabor DRM_FORMAT_ARGB8888, 197219019Sgabor DRM_FORMAT_XRGB8888, 198219019Sgabor}; 199219019Sgabor 200219019Sgaborint rcar_du_writeback_init(struct rcar_du_device *rcdu, 201219019Sgabor struct rcar_du_crtc *rcrtc) 202219019Sgabor{ 203219019Sgabor struct drm_writeback_connector *wb_conn = &rcrtc->writeback; 204219019Sgabor 205219019Sgabor drm_connector_helper_add(&wb_conn->base, 206219019Sgabor &rcar_du_wb_conn_helper_funcs); 207219019Sgabor 208219019Sgabor return drm_writeback_connector_init(&rcdu->ddev, wb_conn, 209219019Sgabor &rcar_du_wb_conn_funcs, 210219019Sgabor &rcar_du_wb_enc_helper_funcs, 211219019Sgabor writeback_formats, 212219019Sgabor ARRAY_SIZE(writeback_formats), 213219019Sgabor 1 << drm_crtc_index(&rcrtc->crtc)); 214219019Sgabor} 215219019Sgabor 216219019Sgaborvoid rcar_du_writeback_setup(struct rcar_du_crtc *rcrtc, 217219019Sgabor struct vsp1_du_writeback_config *cfg) 218219019Sgabor{ 219219019Sgabor struct rcar_du_wb_conn_state *wb_state; 220219019Sgabor struct drm_connector_state *state; 221219019Sgabor struct rcar_du_wb_job *rjob; 222219019Sgabor struct drm_framebuffer *fb; 223219019Sgabor unsigned int i; 224219019Sgabor 225219019Sgabor state = rcrtc->writeback.base.state; 226219019Sgabor if (!state || !state->writeback_job) 227219019Sgabor return; 228219019Sgabor 229219019Sgabor fb = state->writeback_job->fb; 230219019Sgabor rjob = state->writeback_job->priv; 231219019Sgabor wb_state = to_rcar_wb_conn_state(state); 232219019Sgabor 233219019Sgabor cfg->pixelformat = wb_state->format->v4l2; 234219019Sgabor cfg->pitch = fb->pitches[0]; 235219019Sgabor 236219019Sgabor for (i = 0; i < wb_state->format->planes; ++i) 237219019Sgabor cfg->mem[i] = sg_dma_address(rjob->sg_tables[i].sgl) 238219019Sgabor + fb->offsets[i]; 239219019Sgabor 240219019Sgabor drm_writeback_queue_job(&rcrtc->writeback, state); 241219019Sgabor} 242219019Sgabor 243219019Sgaborvoid rcar_du_writeback_complete(struct rcar_du_crtc *rcrtc) 244219019Sgabor{ 245219019Sgabor drm_writeback_signal_completion(&rcrtc->writeback, 0); 246219019Sgabor} 247219019Sgabor