1dee8268fSThierry Reding /* 2dee8268fSThierry Reding * Copyright (C) 2012 Avionic Design GmbH 3dee8268fSThierry Reding * Copyright (C) 2012 NVIDIA CORPORATION. All rights reserved. 4dee8268fSThierry Reding * 5dee8268fSThierry Reding * This program is free software; you can redistribute it and/or modify 6dee8268fSThierry Reding * it under the terms of the GNU General Public License version 2 as 7dee8268fSThierry Reding * published by the Free Software Foundation. 8dee8268fSThierry Reding */ 9dee8268fSThierry Reding 10dee8268fSThierry Reding #include <linux/clk.h> 11dee8268fSThierry Reding #include <linux/clk/tegra.h> 12dee8268fSThierry Reding #include <linux/debugfs.h> 13dee8268fSThierry Reding 14dee8268fSThierry Reding #include "dc.h" 15dee8268fSThierry Reding #include "drm.h" 16dee8268fSThierry Reding #include "gem.h" 17dee8268fSThierry Reding 18dee8268fSThierry Reding struct tegra_plane { 19dee8268fSThierry Reding struct drm_plane base; 20dee8268fSThierry Reding unsigned int index; 21dee8268fSThierry Reding }; 22dee8268fSThierry Reding 23dee8268fSThierry Reding static inline struct tegra_plane *to_tegra_plane(struct drm_plane *plane) 24dee8268fSThierry Reding { 25dee8268fSThierry Reding return container_of(plane, struct tegra_plane, base); 26dee8268fSThierry Reding } 27dee8268fSThierry Reding 28dee8268fSThierry Reding static int tegra_plane_update(struct drm_plane *plane, struct drm_crtc *crtc, 29dee8268fSThierry Reding struct drm_framebuffer *fb, int crtc_x, 30dee8268fSThierry Reding int crtc_y, unsigned int crtc_w, 31dee8268fSThierry Reding unsigned int crtc_h, uint32_t src_x, 32dee8268fSThierry Reding uint32_t src_y, uint32_t src_w, uint32_t src_h) 33dee8268fSThierry Reding { 34dee8268fSThierry Reding struct tegra_plane *p = to_tegra_plane(plane); 35dee8268fSThierry Reding struct tegra_dc *dc = to_tegra_dc(crtc); 36dee8268fSThierry Reding struct tegra_dc_window window; 37dee8268fSThierry Reding unsigned int i; 38dee8268fSThierry Reding 39dee8268fSThierry Reding memset(&window, 0, sizeof(window)); 40dee8268fSThierry Reding window.src.x = src_x >> 16; 41dee8268fSThierry Reding window.src.y = src_y >> 16; 42dee8268fSThierry Reding window.src.w = src_w >> 16; 43dee8268fSThierry Reding window.src.h = src_h >> 16; 44dee8268fSThierry Reding window.dst.x = crtc_x; 45dee8268fSThierry Reding window.dst.y = crtc_y; 46dee8268fSThierry Reding window.dst.w = crtc_w; 47dee8268fSThierry Reding window.dst.h = crtc_h; 48dee8268fSThierry Reding window.format = tegra_dc_format(fb->pixel_format); 49dee8268fSThierry Reding window.bits_per_pixel = fb->bits_per_pixel; 50dee8268fSThierry Reding 51dee8268fSThierry Reding for (i = 0; i < drm_format_num_planes(fb->pixel_format); i++) { 52dee8268fSThierry Reding struct tegra_bo *bo = tegra_fb_get_plane(fb, i); 53dee8268fSThierry Reding 54dee8268fSThierry Reding window.base[i] = bo->paddr + fb->offsets[i]; 55dee8268fSThierry Reding 56dee8268fSThierry Reding /* 57dee8268fSThierry Reding * Tegra doesn't support different strides for U and V planes 58dee8268fSThierry Reding * so we display a warning if the user tries to display a 59dee8268fSThierry Reding * framebuffer with such a configuration. 60dee8268fSThierry Reding */ 61dee8268fSThierry Reding if (i >= 2) { 62dee8268fSThierry Reding if (fb->pitches[i] != window.stride[1]) 63dee8268fSThierry Reding DRM_ERROR("unsupported UV-plane configuration\n"); 64dee8268fSThierry Reding } else { 65dee8268fSThierry Reding window.stride[i] = fb->pitches[i]; 66dee8268fSThierry Reding } 67dee8268fSThierry Reding } 68dee8268fSThierry Reding 69dee8268fSThierry Reding return tegra_dc_setup_window(dc, p->index, &window); 70dee8268fSThierry Reding } 71dee8268fSThierry Reding 72dee8268fSThierry Reding static int tegra_plane_disable(struct drm_plane *plane) 73dee8268fSThierry Reding { 74dee8268fSThierry Reding struct tegra_dc *dc = to_tegra_dc(plane->crtc); 75dee8268fSThierry Reding struct tegra_plane *p = to_tegra_plane(plane); 76dee8268fSThierry Reding unsigned long value; 77dee8268fSThierry Reding 78dee8268fSThierry Reding if (!plane->crtc) 79dee8268fSThierry Reding return 0; 80dee8268fSThierry Reding 81dee8268fSThierry Reding value = WINDOW_A_SELECT << p->index; 82dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_CMD_DISPLAY_WINDOW_HEADER); 83dee8268fSThierry Reding 84dee8268fSThierry Reding value = tegra_dc_readl(dc, DC_WIN_WIN_OPTIONS); 85dee8268fSThierry Reding value &= ~WIN_ENABLE; 86dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_WIN_WIN_OPTIONS); 87dee8268fSThierry Reding 88dee8268fSThierry Reding tegra_dc_writel(dc, WIN_A_UPDATE << p->index, DC_CMD_STATE_CONTROL); 89dee8268fSThierry Reding tegra_dc_writel(dc, WIN_A_ACT_REQ << p->index, DC_CMD_STATE_CONTROL); 90dee8268fSThierry Reding 91dee8268fSThierry Reding return 0; 92dee8268fSThierry Reding } 93dee8268fSThierry Reding 94dee8268fSThierry Reding static void tegra_plane_destroy(struct drm_plane *plane) 95dee8268fSThierry Reding { 96*f002abc1SThierry Reding struct tegra_plane *p = to_tegra_plane(plane); 97*f002abc1SThierry Reding 98dee8268fSThierry Reding tegra_plane_disable(plane); 99dee8268fSThierry Reding drm_plane_cleanup(plane); 100*f002abc1SThierry Reding kfree(p); 101dee8268fSThierry Reding } 102dee8268fSThierry Reding 103dee8268fSThierry Reding static const struct drm_plane_funcs tegra_plane_funcs = { 104dee8268fSThierry Reding .update_plane = tegra_plane_update, 105dee8268fSThierry Reding .disable_plane = tegra_plane_disable, 106dee8268fSThierry Reding .destroy = tegra_plane_destroy, 107dee8268fSThierry Reding }; 108dee8268fSThierry Reding 109dee8268fSThierry Reding static const uint32_t plane_formats[] = { 110dee8268fSThierry Reding DRM_FORMAT_XBGR8888, 111dee8268fSThierry Reding DRM_FORMAT_XRGB8888, 112dee8268fSThierry Reding DRM_FORMAT_RGB565, 113dee8268fSThierry Reding DRM_FORMAT_UYVY, 114dee8268fSThierry Reding DRM_FORMAT_YUV420, 115dee8268fSThierry Reding DRM_FORMAT_YUV422, 116dee8268fSThierry Reding }; 117dee8268fSThierry Reding 118dee8268fSThierry Reding static int tegra_dc_add_planes(struct drm_device *drm, struct tegra_dc *dc) 119dee8268fSThierry Reding { 120dee8268fSThierry Reding unsigned int i; 121dee8268fSThierry Reding int err = 0; 122dee8268fSThierry Reding 123dee8268fSThierry Reding for (i = 0; i < 2; i++) { 124dee8268fSThierry Reding struct tegra_plane *plane; 125dee8268fSThierry Reding 126*f002abc1SThierry Reding plane = kzalloc(sizeof(*plane), GFP_KERNEL); 127dee8268fSThierry Reding if (!plane) 128dee8268fSThierry Reding return -ENOMEM; 129dee8268fSThierry Reding 130dee8268fSThierry Reding plane->index = 1 + i; 131dee8268fSThierry Reding 132dee8268fSThierry Reding err = drm_plane_init(drm, &plane->base, 1 << dc->pipe, 133dee8268fSThierry Reding &tegra_plane_funcs, plane_formats, 134dee8268fSThierry Reding ARRAY_SIZE(plane_formats), false); 135*f002abc1SThierry Reding if (err < 0) { 136*f002abc1SThierry Reding kfree(plane); 137dee8268fSThierry Reding return err; 138dee8268fSThierry Reding } 139*f002abc1SThierry Reding } 140dee8268fSThierry Reding 141dee8268fSThierry Reding return 0; 142dee8268fSThierry Reding } 143dee8268fSThierry Reding 144dee8268fSThierry Reding static int tegra_dc_set_base(struct tegra_dc *dc, int x, int y, 145dee8268fSThierry Reding struct drm_framebuffer *fb) 146dee8268fSThierry Reding { 147dee8268fSThierry Reding unsigned int format = tegra_dc_format(fb->pixel_format); 148dee8268fSThierry Reding struct tegra_bo *bo = tegra_fb_get_plane(fb, 0); 149dee8268fSThierry Reding unsigned long value; 150dee8268fSThierry Reding 151dee8268fSThierry Reding tegra_dc_writel(dc, WINDOW_A_SELECT, DC_CMD_DISPLAY_WINDOW_HEADER); 152dee8268fSThierry Reding 153dee8268fSThierry Reding value = fb->offsets[0] + y * fb->pitches[0] + 154dee8268fSThierry Reding x * fb->bits_per_pixel / 8; 155dee8268fSThierry Reding 156dee8268fSThierry Reding tegra_dc_writel(dc, bo->paddr + value, DC_WINBUF_START_ADDR); 157dee8268fSThierry Reding tegra_dc_writel(dc, fb->pitches[0], DC_WIN_LINE_STRIDE); 158dee8268fSThierry Reding tegra_dc_writel(dc, format, DC_WIN_COLOR_DEPTH); 159dee8268fSThierry Reding 160dee8268fSThierry Reding value = GENERAL_UPDATE | WIN_A_UPDATE; 161dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_CMD_STATE_CONTROL); 162dee8268fSThierry Reding 163dee8268fSThierry Reding value = GENERAL_ACT_REQ | WIN_A_ACT_REQ; 164dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_CMD_STATE_CONTROL); 165dee8268fSThierry Reding 166dee8268fSThierry Reding return 0; 167dee8268fSThierry Reding } 168dee8268fSThierry Reding 169dee8268fSThierry Reding void tegra_dc_enable_vblank(struct tegra_dc *dc) 170dee8268fSThierry Reding { 171dee8268fSThierry Reding unsigned long value, flags; 172dee8268fSThierry Reding 173dee8268fSThierry Reding spin_lock_irqsave(&dc->lock, flags); 174dee8268fSThierry Reding 175dee8268fSThierry Reding value = tegra_dc_readl(dc, DC_CMD_INT_MASK); 176dee8268fSThierry Reding value |= VBLANK_INT; 177dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_CMD_INT_MASK); 178dee8268fSThierry Reding 179dee8268fSThierry Reding spin_unlock_irqrestore(&dc->lock, flags); 180dee8268fSThierry Reding } 181dee8268fSThierry Reding 182dee8268fSThierry Reding void tegra_dc_disable_vblank(struct tegra_dc *dc) 183dee8268fSThierry Reding { 184dee8268fSThierry Reding unsigned long value, flags; 185dee8268fSThierry Reding 186dee8268fSThierry Reding spin_lock_irqsave(&dc->lock, flags); 187dee8268fSThierry Reding 188dee8268fSThierry Reding value = tegra_dc_readl(dc, DC_CMD_INT_MASK); 189dee8268fSThierry Reding value &= ~VBLANK_INT; 190dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_CMD_INT_MASK); 191dee8268fSThierry Reding 192dee8268fSThierry Reding spin_unlock_irqrestore(&dc->lock, flags); 193dee8268fSThierry Reding } 194dee8268fSThierry Reding 195dee8268fSThierry Reding static void tegra_dc_finish_page_flip(struct tegra_dc *dc) 196dee8268fSThierry Reding { 197dee8268fSThierry Reding struct drm_device *drm = dc->base.dev; 198dee8268fSThierry Reding struct drm_crtc *crtc = &dc->base; 199dee8268fSThierry Reding unsigned long flags, base; 200dee8268fSThierry Reding struct tegra_bo *bo; 201dee8268fSThierry Reding 202dee8268fSThierry Reding if (!dc->event) 203dee8268fSThierry Reding return; 204dee8268fSThierry Reding 205dee8268fSThierry Reding bo = tegra_fb_get_plane(crtc->fb, 0); 206dee8268fSThierry Reding 207dee8268fSThierry Reding /* check if new start address has been latched */ 208dee8268fSThierry Reding tegra_dc_writel(dc, READ_MUX, DC_CMD_STATE_ACCESS); 209dee8268fSThierry Reding base = tegra_dc_readl(dc, DC_WINBUF_START_ADDR); 210dee8268fSThierry Reding tegra_dc_writel(dc, 0, DC_CMD_STATE_ACCESS); 211dee8268fSThierry Reding 212dee8268fSThierry Reding if (base == bo->paddr + crtc->fb->offsets[0]) { 213dee8268fSThierry Reding spin_lock_irqsave(&drm->event_lock, flags); 214dee8268fSThierry Reding drm_send_vblank_event(drm, dc->pipe, dc->event); 215dee8268fSThierry Reding drm_vblank_put(drm, dc->pipe); 216dee8268fSThierry Reding dc->event = NULL; 217dee8268fSThierry Reding spin_unlock_irqrestore(&drm->event_lock, flags); 218dee8268fSThierry Reding } 219dee8268fSThierry Reding } 220dee8268fSThierry Reding 221dee8268fSThierry Reding void tegra_dc_cancel_page_flip(struct drm_crtc *crtc, struct drm_file *file) 222dee8268fSThierry Reding { 223dee8268fSThierry Reding struct tegra_dc *dc = to_tegra_dc(crtc); 224dee8268fSThierry Reding struct drm_device *drm = crtc->dev; 225dee8268fSThierry Reding unsigned long flags; 226dee8268fSThierry Reding 227dee8268fSThierry Reding spin_lock_irqsave(&drm->event_lock, flags); 228dee8268fSThierry Reding 229dee8268fSThierry Reding if (dc->event && dc->event->base.file_priv == file) { 230dee8268fSThierry Reding dc->event->base.destroy(&dc->event->base); 231dee8268fSThierry Reding drm_vblank_put(drm, dc->pipe); 232dee8268fSThierry Reding dc->event = NULL; 233dee8268fSThierry Reding } 234dee8268fSThierry Reding 235dee8268fSThierry Reding spin_unlock_irqrestore(&drm->event_lock, flags); 236dee8268fSThierry Reding } 237dee8268fSThierry Reding 238dee8268fSThierry Reding static int tegra_dc_page_flip(struct drm_crtc *crtc, struct drm_framebuffer *fb, 239dee8268fSThierry Reding struct drm_pending_vblank_event *event, uint32_t page_flip_flags) 240dee8268fSThierry Reding { 241dee8268fSThierry Reding struct tegra_dc *dc = to_tegra_dc(crtc); 242dee8268fSThierry Reding struct drm_device *drm = crtc->dev; 243dee8268fSThierry Reding 244dee8268fSThierry Reding if (dc->event) 245dee8268fSThierry Reding return -EBUSY; 246dee8268fSThierry Reding 247dee8268fSThierry Reding if (event) { 248dee8268fSThierry Reding event->pipe = dc->pipe; 249dee8268fSThierry Reding dc->event = event; 250dee8268fSThierry Reding drm_vblank_get(drm, dc->pipe); 251dee8268fSThierry Reding } 252dee8268fSThierry Reding 253dee8268fSThierry Reding tegra_dc_set_base(dc, 0, 0, fb); 254dee8268fSThierry Reding crtc->fb = fb; 255dee8268fSThierry Reding 256dee8268fSThierry Reding return 0; 257dee8268fSThierry Reding } 258dee8268fSThierry Reding 259*f002abc1SThierry Reding static void drm_crtc_clear(struct drm_crtc *crtc) 260*f002abc1SThierry Reding { 261*f002abc1SThierry Reding memset(crtc, 0, sizeof(*crtc)); 262*f002abc1SThierry Reding } 263*f002abc1SThierry Reding 264*f002abc1SThierry Reding static void tegra_dc_destroy(struct drm_crtc *crtc) 265*f002abc1SThierry Reding { 266*f002abc1SThierry Reding drm_crtc_cleanup(crtc); 267*f002abc1SThierry Reding drm_crtc_clear(crtc); 268*f002abc1SThierry Reding } 269*f002abc1SThierry Reding 270dee8268fSThierry Reding static const struct drm_crtc_funcs tegra_crtc_funcs = { 271dee8268fSThierry Reding .page_flip = tegra_dc_page_flip, 272dee8268fSThierry Reding .set_config = drm_crtc_helper_set_config, 273*f002abc1SThierry Reding .destroy = tegra_dc_destroy, 274dee8268fSThierry Reding }; 275dee8268fSThierry Reding 276dee8268fSThierry Reding static void tegra_crtc_disable(struct drm_crtc *crtc) 277dee8268fSThierry Reding { 278*f002abc1SThierry Reding struct tegra_dc *dc = to_tegra_dc(crtc); 279dee8268fSThierry Reding struct drm_device *drm = crtc->dev; 280dee8268fSThierry Reding struct drm_plane *plane; 281dee8268fSThierry Reding 282dee8268fSThierry Reding list_for_each_entry(plane, &drm->mode_config.plane_list, head) { 283dee8268fSThierry Reding if (plane->crtc == crtc) { 284dee8268fSThierry Reding tegra_plane_disable(plane); 285dee8268fSThierry Reding plane->crtc = NULL; 286dee8268fSThierry Reding 287dee8268fSThierry Reding if (plane->fb) { 288dee8268fSThierry Reding drm_framebuffer_unreference(plane->fb); 289dee8268fSThierry Reding plane->fb = NULL; 290dee8268fSThierry Reding } 291dee8268fSThierry Reding } 292dee8268fSThierry Reding } 293*f002abc1SThierry Reding 294*f002abc1SThierry Reding drm_vblank_off(drm, dc->pipe); 295dee8268fSThierry Reding } 296dee8268fSThierry Reding 297dee8268fSThierry Reding static bool tegra_crtc_mode_fixup(struct drm_crtc *crtc, 298dee8268fSThierry Reding const struct drm_display_mode *mode, 299dee8268fSThierry Reding struct drm_display_mode *adjusted) 300dee8268fSThierry Reding { 301dee8268fSThierry Reding return true; 302dee8268fSThierry Reding } 303dee8268fSThierry Reding 304dee8268fSThierry Reding static inline u32 compute_dda_inc(unsigned int in, unsigned int out, bool v, 305dee8268fSThierry Reding unsigned int bpp) 306dee8268fSThierry Reding { 307dee8268fSThierry Reding fixed20_12 outf = dfixed_init(out); 308dee8268fSThierry Reding fixed20_12 inf = dfixed_init(in); 309dee8268fSThierry Reding u32 dda_inc; 310dee8268fSThierry Reding int max; 311dee8268fSThierry Reding 312dee8268fSThierry Reding if (v) 313dee8268fSThierry Reding max = 15; 314dee8268fSThierry Reding else { 315dee8268fSThierry Reding switch (bpp) { 316dee8268fSThierry Reding case 2: 317dee8268fSThierry Reding max = 8; 318dee8268fSThierry Reding break; 319dee8268fSThierry Reding 320dee8268fSThierry Reding default: 321dee8268fSThierry Reding WARN_ON_ONCE(1); 322dee8268fSThierry Reding /* fallthrough */ 323dee8268fSThierry Reding case 4: 324dee8268fSThierry Reding max = 4; 325dee8268fSThierry Reding break; 326dee8268fSThierry Reding } 327dee8268fSThierry Reding } 328dee8268fSThierry Reding 329dee8268fSThierry Reding outf.full = max_t(u32, outf.full - dfixed_const(1), dfixed_const(1)); 330dee8268fSThierry Reding inf.full -= dfixed_const(1); 331dee8268fSThierry Reding 332dee8268fSThierry Reding dda_inc = dfixed_div(inf, outf); 333dee8268fSThierry Reding dda_inc = min_t(u32, dda_inc, dfixed_const(max)); 334dee8268fSThierry Reding 335dee8268fSThierry Reding return dda_inc; 336dee8268fSThierry Reding } 337dee8268fSThierry Reding 338dee8268fSThierry Reding static inline u32 compute_initial_dda(unsigned int in) 339dee8268fSThierry Reding { 340dee8268fSThierry Reding fixed20_12 inf = dfixed_init(in); 341dee8268fSThierry Reding return dfixed_frac(inf); 342dee8268fSThierry Reding } 343dee8268fSThierry Reding 344dee8268fSThierry Reding static int tegra_dc_set_timings(struct tegra_dc *dc, 345dee8268fSThierry Reding struct drm_display_mode *mode) 346dee8268fSThierry Reding { 347dee8268fSThierry Reding /* TODO: For HDMI compliance, h & v ref_to_sync should be set to 1 */ 348dee8268fSThierry Reding unsigned int h_ref_to_sync = 0; 349dee8268fSThierry Reding unsigned int v_ref_to_sync = 0; 350dee8268fSThierry Reding unsigned long value; 351dee8268fSThierry Reding 352dee8268fSThierry Reding tegra_dc_writel(dc, 0x0, DC_DISP_DISP_TIMING_OPTIONS); 353dee8268fSThierry Reding 354dee8268fSThierry Reding value = (v_ref_to_sync << 16) | h_ref_to_sync; 355dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_DISP_REF_TO_SYNC); 356dee8268fSThierry Reding 357dee8268fSThierry Reding value = ((mode->vsync_end - mode->vsync_start) << 16) | 358dee8268fSThierry Reding ((mode->hsync_end - mode->hsync_start) << 0); 359dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_DISP_SYNC_WIDTH); 360dee8268fSThierry Reding 361dee8268fSThierry Reding value = ((mode->vtotal - mode->vsync_end) << 16) | 362dee8268fSThierry Reding ((mode->htotal - mode->hsync_end) << 0); 363dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_DISP_BACK_PORCH); 364dee8268fSThierry Reding 365dee8268fSThierry Reding value = ((mode->vsync_start - mode->vdisplay) << 16) | 366dee8268fSThierry Reding ((mode->hsync_start - mode->hdisplay) << 0); 367dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_DISP_FRONT_PORCH); 368dee8268fSThierry Reding 369dee8268fSThierry Reding value = (mode->vdisplay << 16) | mode->hdisplay; 370dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_DISP_ACTIVE); 371dee8268fSThierry Reding 372dee8268fSThierry Reding return 0; 373dee8268fSThierry Reding } 374dee8268fSThierry Reding 375dee8268fSThierry Reding static int tegra_crtc_setup_clk(struct drm_crtc *crtc, 376dee8268fSThierry Reding struct drm_display_mode *mode, 377dee8268fSThierry Reding unsigned long *div) 378dee8268fSThierry Reding { 379dee8268fSThierry Reding unsigned long pclk = mode->clock * 1000, rate; 380dee8268fSThierry Reding struct tegra_dc *dc = to_tegra_dc(crtc); 381dee8268fSThierry Reding struct tegra_output *output = NULL; 382dee8268fSThierry Reding struct drm_encoder *encoder; 383dee8268fSThierry Reding long err; 384dee8268fSThierry Reding 385dee8268fSThierry Reding list_for_each_entry(encoder, &crtc->dev->mode_config.encoder_list, head) 386dee8268fSThierry Reding if (encoder->crtc == crtc) { 387dee8268fSThierry Reding output = encoder_to_output(encoder); 388dee8268fSThierry Reding break; 389dee8268fSThierry Reding } 390dee8268fSThierry Reding 391dee8268fSThierry Reding if (!output) 392dee8268fSThierry Reding return -ENODEV; 393dee8268fSThierry Reding 394dee8268fSThierry Reding /* 395dee8268fSThierry Reding * This assumes that the display controller will divide its parent 396dee8268fSThierry Reding * clock by 2 to generate the pixel clock. 397dee8268fSThierry Reding */ 398dee8268fSThierry Reding err = tegra_output_setup_clock(output, dc->clk, pclk * 2); 399dee8268fSThierry Reding if (err < 0) { 400dee8268fSThierry Reding dev_err(dc->dev, "failed to setup clock: %ld\n", err); 401dee8268fSThierry Reding return err; 402dee8268fSThierry Reding } 403dee8268fSThierry Reding 404dee8268fSThierry Reding rate = clk_get_rate(dc->clk); 405dee8268fSThierry Reding *div = (rate * 2 / pclk) - 2; 406dee8268fSThierry Reding 407dee8268fSThierry Reding DRM_DEBUG_KMS("rate: %lu, div: %lu\n", rate, *div); 408dee8268fSThierry Reding 409dee8268fSThierry Reding return 0; 410dee8268fSThierry Reding } 411dee8268fSThierry Reding 412dee8268fSThierry Reding static bool tegra_dc_format_is_yuv(unsigned int format, bool *planar) 413dee8268fSThierry Reding { 414dee8268fSThierry Reding switch (format) { 415dee8268fSThierry Reding case WIN_COLOR_DEPTH_YCbCr422: 416dee8268fSThierry Reding case WIN_COLOR_DEPTH_YUV422: 417dee8268fSThierry Reding if (planar) 418dee8268fSThierry Reding *planar = false; 419dee8268fSThierry Reding 420dee8268fSThierry Reding return true; 421dee8268fSThierry Reding 422dee8268fSThierry Reding case WIN_COLOR_DEPTH_YCbCr420P: 423dee8268fSThierry Reding case WIN_COLOR_DEPTH_YUV420P: 424dee8268fSThierry Reding case WIN_COLOR_DEPTH_YCbCr422P: 425dee8268fSThierry Reding case WIN_COLOR_DEPTH_YUV422P: 426dee8268fSThierry Reding case WIN_COLOR_DEPTH_YCbCr422R: 427dee8268fSThierry Reding case WIN_COLOR_DEPTH_YUV422R: 428dee8268fSThierry Reding case WIN_COLOR_DEPTH_YCbCr422RA: 429dee8268fSThierry Reding case WIN_COLOR_DEPTH_YUV422RA: 430dee8268fSThierry Reding if (planar) 431dee8268fSThierry Reding *planar = true; 432dee8268fSThierry Reding 433dee8268fSThierry Reding return true; 434dee8268fSThierry Reding } 435dee8268fSThierry Reding 436dee8268fSThierry Reding return false; 437dee8268fSThierry Reding } 438dee8268fSThierry Reding 439dee8268fSThierry Reding int tegra_dc_setup_window(struct tegra_dc *dc, unsigned int index, 440dee8268fSThierry Reding const struct tegra_dc_window *window) 441dee8268fSThierry Reding { 442dee8268fSThierry Reding unsigned h_offset, v_offset, h_size, v_size, h_dda, v_dda, bpp; 443dee8268fSThierry Reding unsigned long value; 444dee8268fSThierry Reding bool yuv, planar; 445dee8268fSThierry Reding 446dee8268fSThierry Reding /* 447dee8268fSThierry Reding * For YUV planar modes, the number of bytes per pixel takes into 448dee8268fSThierry Reding * account only the luma component and therefore is 1. 449dee8268fSThierry Reding */ 450dee8268fSThierry Reding yuv = tegra_dc_format_is_yuv(window->format, &planar); 451dee8268fSThierry Reding if (!yuv) 452dee8268fSThierry Reding bpp = window->bits_per_pixel / 8; 453dee8268fSThierry Reding else 454dee8268fSThierry Reding bpp = planar ? 1 : 2; 455dee8268fSThierry Reding 456dee8268fSThierry Reding value = WINDOW_A_SELECT << index; 457dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_CMD_DISPLAY_WINDOW_HEADER); 458dee8268fSThierry Reding 459dee8268fSThierry Reding tegra_dc_writel(dc, window->format, DC_WIN_COLOR_DEPTH); 460dee8268fSThierry Reding tegra_dc_writel(dc, 0, DC_WIN_BYTE_SWAP); 461dee8268fSThierry Reding 462dee8268fSThierry Reding value = V_POSITION(window->dst.y) | H_POSITION(window->dst.x); 463dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_WIN_POSITION); 464dee8268fSThierry Reding 465dee8268fSThierry Reding value = V_SIZE(window->dst.h) | H_SIZE(window->dst.w); 466dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_WIN_SIZE); 467dee8268fSThierry Reding 468dee8268fSThierry Reding h_offset = window->src.x * bpp; 469dee8268fSThierry Reding v_offset = window->src.y; 470dee8268fSThierry Reding h_size = window->src.w * bpp; 471dee8268fSThierry Reding v_size = window->src.h; 472dee8268fSThierry Reding 473dee8268fSThierry Reding value = V_PRESCALED_SIZE(v_size) | H_PRESCALED_SIZE(h_size); 474dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_WIN_PRESCALED_SIZE); 475dee8268fSThierry Reding 476dee8268fSThierry Reding /* 477dee8268fSThierry Reding * For DDA computations the number of bytes per pixel for YUV planar 478dee8268fSThierry Reding * modes needs to take into account all Y, U and V components. 479dee8268fSThierry Reding */ 480dee8268fSThierry Reding if (yuv && planar) 481dee8268fSThierry Reding bpp = 2; 482dee8268fSThierry Reding 483dee8268fSThierry Reding h_dda = compute_dda_inc(window->src.w, window->dst.w, false, bpp); 484dee8268fSThierry Reding v_dda = compute_dda_inc(window->src.h, window->dst.h, true, bpp); 485dee8268fSThierry Reding 486dee8268fSThierry Reding value = V_DDA_INC(v_dda) | H_DDA_INC(h_dda); 487dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_WIN_DDA_INC); 488dee8268fSThierry Reding 489dee8268fSThierry Reding h_dda = compute_initial_dda(window->src.x); 490dee8268fSThierry Reding v_dda = compute_initial_dda(window->src.y); 491dee8268fSThierry Reding 492dee8268fSThierry Reding tegra_dc_writel(dc, h_dda, DC_WIN_H_INITIAL_DDA); 493dee8268fSThierry Reding tegra_dc_writel(dc, v_dda, DC_WIN_V_INITIAL_DDA); 494dee8268fSThierry Reding 495dee8268fSThierry Reding tegra_dc_writel(dc, 0, DC_WIN_UV_BUF_STRIDE); 496dee8268fSThierry Reding tegra_dc_writel(dc, 0, DC_WIN_BUF_STRIDE); 497dee8268fSThierry Reding 498dee8268fSThierry Reding tegra_dc_writel(dc, window->base[0], DC_WINBUF_START_ADDR); 499dee8268fSThierry Reding 500dee8268fSThierry Reding if (yuv && planar) { 501dee8268fSThierry Reding tegra_dc_writel(dc, window->base[1], DC_WINBUF_START_ADDR_U); 502dee8268fSThierry Reding tegra_dc_writel(dc, window->base[2], DC_WINBUF_START_ADDR_V); 503dee8268fSThierry Reding value = window->stride[1] << 16 | window->stride[0]; 504dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_WIN_LINE_STRIDE); 505dee8268fSThierry Reding } else { 506dee8268fSThierry Reding tegra_dc_writel(dc, window->stride[0], DC_WIN_LINE_STRIDE); 507dee8268fSThierry Reding } 508dee8268fSThierry Reding 509dee8268fSThierry Reding tegra_dc_writel(dc, h_offset, DC_WINBUF_ADDR_H_OFFSET); 510dee8268fSThierry Reding tegra_dc_writel(dc, v_offset, DC_WINBUF_ADDR_V_OFFSET); 511dee8268fSThierry Reding 512dee8268fSThierry Reding value = WIN_ENABLE; 513dee8268fSThierry Reding 514dee8268fSThierry Reding if (yuv) { 515dee8268fSThierry Reding /* setup default colorspace conversion coefficients */ 516dee8268fSThierry Reding tegra_dc_writel(dc, 0x00f0, DC_WIN_CSC_YOF); 517dee8268fSThierry Reding tegra_dc_writel(dc, 0x012a, DC_WIN_CSC_KYRGB); 518dee8268fSThierry Reding tegra_dc_writel(dc, 0x0000, DC_WIN_CSC_KUR); 519dee8268fSThierry Reding tegra_dc_writel(dc, 0x0198, DC_WIN_CSC_KVR); 520dee8268fSThierry Reding tegra_dc_writel(dc, 0x039b, DC_WIN_CSC_KUG); 521dee8268fSThierry Reding tegra_dc_writel(dc, 0x032f, DC_WIN_CSC_KVG); 522dee8268fSThierry Reding tegra_dc_writel(dc, 0x0204, DC_WIN_CSC_KUB); 523dee8268fSThierry Reding tegra_dc_writel(dc, 0x0000, DC_WIN_CSC_KVB); 524dee8268fSThierry Reding 525dee8268fSThierry Reding value |= CSC_ENABLE; 526dee8268fSThierry Reding } else if (window->bits_per_pixel < 24) { 527dee8268fSThierry Reding value |= COLOR_EXPAND; 528dee8268fSThierry Reding } 529dee8268fSThierry Reding 530dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_WIN_WIN_OPTIONS); 531dee8268fSThierry Reding 532dee8268fSThierry Reding /* 533dee8268fSThierry Reding * Disable blending and assume Window A is the bottom-most window, 534dee8268fSThierry Reding * Window C is the top-most window and Window B is in the middle. 535dee8268fSThierry Reding */ 536dee8268fSThierry Reding tegra_dc_writel(dc, 0xffff00, DC_WIN_BLEND_NOKEY); 537dee8268fSThierry Reding tegra_dc_writel(dc, 0xffff00, DC_WIN_BLEND_1WIN); 538dee8268fSThierry Reding 539dee8268fSThierry Reding switch (index) { 540dee8268fSThierry Reding case 0: 541dee8268fSThierry Reding tegra_dc_writel(dc, 0x000000, DC_WIN_BLEND_2WIN_X); 542dee8268fSThierry Reding tegra_dc_writel(dc, 0x000000, DC_WIN_BLEND_2WIN_Y); 543dee8268fSThierry Reding tegra_dc_writel(dc, 0x000000, DC_WIN_BLEND_3WIN_XY); 544dee8268fSThierry Reding break; 545dee8268fSThierry Reding 546dee8268fSThierry Reding case 1: 547dee8268fSThierry Reding tegra_dc_writel(dc, 0xffff00, DC_WIN_BLEND_2WIN_X); 548dee8268fSThierry Reding tegra_dc_writel(dc, 0x000000, DC_WIN_BLEND_2WIN_Y); 549dee8268fSThierry Reding tegra_dc_writel(dc, 0x000000, DC_WIN_BLEND_3WIN_XY); 550dee8268fSThierry Reding break; 551dee8268fSThierry Reding 552dee8268fSThierry Reding case 2: 553dee8268fSThierry Reding tegra_dc_writel(dc, 0xffff00, DC_WIN_BLEND_2WIN_X); 554dee8268fSThierry Reding tegra_dc_writel(dc, 0xffff00, DC_WIN_BLEND_2WIN_Y); 555dee8268fSThierry Reding tegra_dc_writel(dc, 0xffff00, DC_WIN_BLEND_3WIN_XY); 556dee8268fSThierry Reding break; 557dee8268fSThierry Reding } 558dee8268fSThierry Reding 559dee8268fSThierry Reding tegra_dc_writel(dc, WIN_A_UPDATE << index, DC_CMD_STATE_CONTROL); 560dee8268fSThierry Reding tegra_dc_writel(dc, WIN_A_ACT_REQ << index, DC_CMD_STATE_CONTROL); 561dee8268fSThierry Reding 562dee8268fSThierry Reding return 0; 563dee8268fSThierry Reding } 564dee8268fSThierry Reding 565dee8268fSThierry Reding unsigned int tegra_dc_format(uint32_t format) 566dee8268fSThierry Reding { 567dee8268fSThierry Reding switch (format) { 568dee8268fSThierry Reding case DRM_FORMAT_XBGR8888: 569dee8268fSThierry Reding return WIN_COLOR_DEPTH_R8G8B8A8; 570dee8268fSThierry Reding 571dee8268fSThierry Reding case DRM_FORMAT_XRGB8888: 572dee8268fSThierry Reding return WIN_COLOR_DEPTH_B8G8R8A8; 573dee8268fSThierry Reding 574dee8268fSThierry Reding case DRM_FORMAT_RGB565: 575dee8268fSThierry Reding return WIN_COLOR_DEPTH_B5G6R5; 576dee8268fSThierry Reding 577dee8268fSThierry Reding case DRM_FORMAT_UYVY: 578dee8268fSThierry Reding return WIN_COLOR_DEPTH_YCbCr422; 579dee8268fSThierry Reding 580dee8268fSThierry Reding case DRM_FORMAT_YUV420: 581dee8268fSThierry Reding return WIN_COLOR_DEPTH_YCbCr420P; 582dee8268fSThierry Reding 583dee8268fSThierry Reding case DRM_FORMAT_YUV422: 584dee8268fSThierry Reding return WIN_COLOR_DEPTH_YCbCr422P; 585dee8268fSThierry Reding 586dee8268fSThierry Reding default: 587dee8268fSThierry Reding break; 588dee8268fSThierry Reding } 589dee8268fSThierry Reding 590dee8268fSThierry Reding WARN(1, "unsupported pixel format %u, using default\n", format); 591dee8268fSThierry Reding return WIN_COLOR_DEPTH_B8G8R8A8; 592dee8268fSThierry Reding } 593dee8268fSThierry Reding 594dee8268fSThierry Reding static int tegra_crtc_mode_set(struct drm_crtc *crtc, 595dee8268fSThierry Reding struct drm_display_mode *mode, 596dee8268fSThierry Reding struct drm_display_mode *adjusted, 597dee8268fSThierry Reding int x, int y, struct drm_framebuffer *old_fb) 598dee8268fSThierry Reding { 599dee8268fSThierry Reding struct tegra_bo *bo = tegra_fb_get_plane(crtc->fb, 0); 600dee8268fSThierry Reding struct tegra_dc *dc = to_tegra_dc(crtc); 601dee8268fSThierry Reding struct tegra_dc_window window; 602dee8268fSThierry Reding unsigned long div, value; 603dee8268fSThierry Reding int err; 604dee8268fSThierry Reding 605dee8268fSThierry Reding drm_vblank_pre_modeset(crtc->dev, dc->pipe); 606dee8268fSThierry Reding 607dee8268fSThierry Reding err = tegra_crtc_setup_clk(crtc, mode, &div); 608dee8268fSThierry Reding if (err) { 609dee8268fSThierry Reding dev_err(dc->dev, "failed to setup clock for CRTC: %d\n", err); 610dee8268fSThierry Reding return err; 611dee8268fSThierry Reding } 612dee8268fSThierry Reding 613dee8268fSThierry Reding /* program display mode */ 614dee8268fSThierry Reding tegra_dc_set_timings(dc, mode); 615dee8268fSThierry Reding 616dee8268fSThierry Reding value = DE_SELECT_ACTIVE | DE_CONTROL_NORMAL; 617dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_DISP_DATA_ENABLE_OPTIONS); 618dee8268fSThierry Reding 619dee8268fSThierry Reding value = tegra_dc_readl(dc, DC_COM_PIN_OUTPUT_POLARITY(1)); 620dee8268fSThierry Reding value &= ~LVS_OUTPUT_POLARITY_LOW; 621dee8268fSThierry Reding value &= ~LHS_OUTPUT_POLARITY_LOW; 622dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_COM_PIN_OUTPUT_POLARITY(1)); 623dee8268fSThierry Reding 624dee8268fSThierry Reding value = DISP_DATA_FORMAT_DF1P1C | DISP_ALIGNMENT_MSB | 625dee8268fSThierry Reding DISP_ORDER_RED_BLUE; 626dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_DISP_DISP_INTERFACE_CONTROL); 627dee8268fSThierry Reding 628dee8268fSThierry Reding tegra_dc_writel(dc, 0x00010001, DC_DISP_SHIFT_CLOCK_OPTIONS); 629dee8268fSThierry Reding 630dee8268fSThierry Reding value = SHIFT_CLK_DIVIDER(div) | PIXEL_CLK_DIVIDER_PCD1; 631dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_DISP_DISP_CLOCK_CONTROL); 632dee8268fSThierry Reding 633dee8268fSThierry Reding /* setup window parameters */ 634dee8268fSThierry Reding memset(&window, 0, sizeof(window)); 635dee8268fSThierry Reding window.src.x = 0; 636dee8268fSThierry Reding window.src.y = 0; 637dee8268fSThierry Reding window.src.w = mode->hdisplay; 638dee8268fSThierry Reding window.src.h = mode->vdisplay; 639dee8268fSThierry Reding window.dst.x = 0; 640dee8268fSThierry Reding window.dst.y = 0; 641dee8268fSThierry Reding window.dst.w = mode->hdisplay; 642dee8268fSThierry Reding window.dst.h = mode->vdisplay; 643dee8268fSThierry Reding window.format = tegra_dc_format(crtc->fb->pixel_format); 644dee8268fSThierry Reding window.bits_per_pixel = crtc->fb->bits_per_pixel; 645dee8268fSThierry Reding window.stride[0] = crtc->fb->pitches[0]; 646dee8268fSThierry Reding window.base[0] = bo->paddr; 647dee8268fSThierry Reding 648dee8268fSThierry Reding err = tegra_dc_setup_window(dc, 0, &window); 649dee8268fSThierry Reding if (err < 0) 650dee8268fSThierry Reding dev_err(dc->dev, "failed to enable root plane\n"); 651dee8268fSThierry Reding 652dee8268fSThierry Reding return 0; 653dee8268fSThierry Reding } 654dee8268fSThierry Reding 655dee8268fSThierry Reding static int tegra_crtc_mode_set_base(struct drm_crtc *crtc, int x, int y, 656dee8268fSThierry Reding struct drm_framebuffer *old_fb) 657dee8268fSThierry Reding { 658dee8268fSThierry Reding struct tegra_dc *dc = to_tegra_dc(crtc); 659dee8268fSThierry Reding 660dee8268fSThierry Reding return tegra_dc_set_base(dc, x, y, crtc->fb); 661dee8268fSThierry Reding } 662dee8268fSThierry Reding 663dee8268fSThierry Reding static void tegra_crtc_prepare(struct drm_crtc *crtc) 664dee8268fSThierry Reding { 665dee8268fSThierry Reding struct tegra_dc *dc = to_tegra_dc(crtc); 666dee8268fSThierry Reding unsigned int syncpt; 667dee8268fSThierry Reding unsigned long value; 668dee8268fSThierry Reding 669dee8268fSThierry Reding /* hardware initialization */ 670dee8268fSThierry Reding tegra_periph_reset_deassert(dc->clk); 671dee8268fSThierry Reding usleep_range(10000, 20000); 672dee8268fSThierry Reding 673dee8268fSThierry Reding if (dc->pipe) 674dee8268fSThierry Reding syncpt = SYNCPT_VBLANK1; 675dee8268fSThierry Reding else 676dee8268fSThierry Reding syncpt = SYNCPT_VBLANK0; 677dee8268fSThierry Reding 678dee8268fSThierry Reding /* initialize display controller */ 679dee8268fSThierry Reding tegra_dc_writel(dc, 0x00000100, DC_CMD_GENERAL_INCR_SYNCPT_CNTRL); 680dee8268fSThierry Reding tegra_dc_writel(dc, 0x100 | syncpt, DC_CMD_CONT_SYNCPT_VSYNC); 681dee8268fSThierry Reding 682dee8268fSThierry Reding value = WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT | WIN_A_OF_INT; 683dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_CMD_INT_TYPE); 684dee8268fSThierry Reding 685dee8268fSThierry Reding value = WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT | 686dee8268fSThierry Reding WIN_A_OF_INT | WIN_B_OF_INT | WIN_C_OF_INT; 687dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_CMD_INT_POLARITY); 688dee8268fSThierry Reding 689dee8268fSThierry Reding value = PW0_ENABLE | PW1_ENABLE | PW2_ENABLE | PW3_ENABLE | 690dee8268fSThierry Reding PW4_ENABLE | PM0_ENABLE | PM1_ENABLE; 691dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_CMD_DISPLAY_POWER_CONTROL); 692dee8268fSThierry Reding 693dee8268fSThierry Reding value = tegra_dc_readl(dc, DC_CMD_DISPLAY_COMMAND); 694dee8268fSThierry Reding value |= DISP_CTRL_MODE_C_DISPLAY; 695dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_CMD_DISPLAY_COMMAND); 696dee8268fSThierry Reding 697dee8268fSThierry Reding /* initialize timer */ 698dee8268fSThierry Reding value = CURSOR_THRESHOLD(0) | WINDOW_A_THRESHOLD(0x20) | 699dee8268fSThierry Reding WINDOW_B_THRESHOLD(0x20) | WINDOW_C_THRESHOLD(0x20); 700dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_DISP_DISP_MEM_HIGH_PRIORITY); 701dee8268fSThierry Reding 702dee8268fSThierry Reding value = CURSOR_THRESHOLD(0) | WINDOW_A_THRESHOLD(1) | 703dee8268fSThierry Reding WINDOW_B_THRESHOLD(1) | WINDOW_C_THRESHOLD(1); 704dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_DISP_DISP_MEM_HIGH_PRIORITY_TIMER); 705dee8268fSThierry Reding 706dee8268fSThierry Reding value = VBLANK_INT | WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT; 707dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_CMD_INT_ENABLE); 708dee8268fSThierry Reding 709dee8268fSThierry Reding value = WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT; 710dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_CMD_INT_MASK); 711dee8268fSThierry Reding } 712dee8268fSThierry Reding 713dee8268fSThierry Reding static void tegra_crtc_commit(struct drm_crtc *crtc) 714dee8268fSThierry Reding { 715dee8268fSThierry Reding struct tegra_dc *dc = to_tegra_dc(crtc); 716dee8268fSThierry Reding unsigned long value; 717dee8268fSThierry Reding 718dee8268fSThierry Reding value = GENERAL_UPDATE | WIN_A_UPDATE; 719dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_CMD_STATE_CONTROL); 720dee8268fSThierry Reding 721dee8268fSThierry Reding value = GENERAL_ACT_REQ | WIN_A_ACT_REQ; 722dee8268fSThierry Reding tegra_dc_writel(dc, value, DC_CMD_STATE_CONTROL); 723dee8268fSThierry Reding 724dee8268fSThierry Reding drm_vblank_post_modeset(crtc->dev, dc->pipe); 725dee8268fSThierry Reding } 726dee8268fSThierry Reding 727dee8268fSThierry Reding static void tegra_crtc_load_lut(struct drm_crtc *crtc) 728dee8268fSThierry Reding { 729dee8268fSThierry Reding } 730dee8268fSThierry Reding 731dee8268fSThierry Reding static const struct drm_crtc_helper_funcs tegra_crtc_helper_funcs = { 732dee8268fSThierry Reding .disable = tegra_crtc_disable, 733dee8268fSThierry Reding .mode_fixup = tegra_crtc_mode_fixup, 734dee8268fSThierry Reding .mode_set = tegra_crtc_mode_set, 735dee8268fSThierry Reding .mode_set_base = tegra_crtc_mode_set_base, 736dee8268fSThierry Reding .prepare = tegra_crtc_prepare, 737dee8268fSThierry Reding .commit = tegra_crtc_commit, 738dee8268fSThierry Reding .load_lut = tegra_crtc_load_lut, 739dee8268fSThierry Reding }; 740dee8268fSThierry Reding 741dee8268fSThierry Reding static irqreturn_t tegra_dc_irq(int irq, void *data) 742dee8268fSThierry Reding { 743dee8268fSThierry Reding struct tegra_dc *dc = data; 744dee8268fSThierry Reding unsigned long status; 745dee8268fSThierry Reding 746dee8268fSThierry Reding status = tegra_dc_readl(dc, DC_CMD_INT_STATUS); 747dee8268fSThierry Reding tegra_dc_writel(dc, status, DC_CMD_INT_STATUS); 748dee8268fSThierry Reding 749dee8268fSThierry Reding if (status & FRAME_END_INT) { 750dee8268fSThierry Reding /* 751dee8268fSThierry Reding dev_dbg(dc->dev, "%s(): frame end\n", __func__); 752dee8268fSThierry Reding */ 753dee8268fSThierry Reding } 754dee8268fSThierry Reding 755dee8268fSThierry Reding if (status & VBLANK_INT) { 756dee8268fSThierry Reding /* 757dee8268fSThierry Reding dev_dbg(dc->dev, "%s(): vertical blank\n", __func__); 758dee8268fSThierry Reding */ 759dee8268fSThierry Reding drm_handle_vblank(dc->base.dev, dc->pipe); 760dee8268fSThierry Reding tegra_dc_finish_page_flip(dc); 761dee8268fSThierry Reding } 762dee8268fSThierry Reding 763dee8268fSThierry Reding if (status & (WIN_A_UF_INT | WIN_B_UF_INT | WIN_C_UF_INT)) { 764dee8268fSThierry Reding /* 765dee8268fSThierry Reding dev_dbg(dc->dev, "%s(): underflow\n", __func__); 766dee8268fSThierry Reding */ 767dee8268fSThierry Reding } 768dee8268fSThierry Reding 769dee8268fSThierry Reding return IRQ_HANDLED; 770dee8268fSThierry Reding } 771dee8268fSThierry Reding 772dee8268fSThierry Reding static int tegra_dc_show_regs(struct seq_file *s, void *data) 773dee8268fSThierry Reding { 774dee8268fSThierry Reding struct drm_info_node *node = s->private; 775dee8268fSThierry Reding struct tegra_dc *dc = node->info_ent->data; 776dee8268fSThierry Reding 777dee8268fSThierry Reding #define DUMP_REG(name) \ 778dee8268fSThierry Reding seq_printf(s, "%-40s %#05x %08lx\n", #name, name, \ 779dee8268fSThierry Reding tegra_dc_readl(dc, name)) 780dee8268fSThierry Reding 781dee8268fSThierry Reding DUMP_REG(DC_CMD_GENERAL_INCR_SYNCPT); 782dee8268fSThierry Reding DUMP_REG(DC_CMD_GENERAL_INCR_SYNCPT_CNTRL); 783dee8268fSThierry Reding DUMP_REG(DC_CMD_GENERAL_INCR_SYNCPT_ERROR); 784dee8268fSThierry Reding DUMP_REG(DC_CMD_WIN_A_INCR_SYNCPT); 785dee8268fSThierry Reding DUMP_REG(DC_CMD_WIN_A_INCR_SYNCPT_CNTRL); 786dee8268fSThierry Reding DUMP_REG(DC_CMD_WIN_A_INCR_SYNCPT_ERROR); 787dee8268fSThierry Reding DUMP_REG(DC_CMD_WIN_B_INCR_SYNCPT); 788dee8268fSThierry Reding DUMP_REG(DC_CMD_WIN_B_INCR_SYNCPT_CNTRL); 789dee8268fSThierry Reding DUMP_REG(DC_CMD_WIN_B_INCR_SYNCPT_ERROR); 790dee8268fSThierry Reding DUMP_REG(DC_CMD_WIN_C_INCR_SYNCPT); 791dee8268fSThierry Reding DUMP_REG(DC_CMD_WIN_C_INCR_SYNCPT_CNTRL); 792dee8268fSThierry Reding DUMP_REG(DC_CMD_WIN_C_INCR_SYNCPT_ERROR); 793dee8268fSThierry Reding DUMP_REG(DC_CMD_CONT_SYNCPT_VSYNC); 794dee8268fSThierry Reding DUMP_REG(DC_CMD_DISPLAY_COMMAND_OPTION0); 795dee8268fSThierry Reding DUMP_REG(DC_CMD_DISPLAY_COMMAND); 796dee8268fSThierry Reding DUMP_REG(DC_CMD_SIGNAL_RAISE); 797dee8268fSThierry Reding DUMP_REG(DC_CMD_DISPLAY_POWER_CONTROL); 798dee8268fSThierry Reding DUMP_REG(DC_CMD_INT_STATUS); 799dee8268fSThierry Reding DUMP_REG(DC_CMD_INT_MASK); 800dee8268fSThierry Reding DUMP_REG(DC_CMD_INT_ENABLE); 801dee8268fSThierry Reding DUMP_REG(DC_CMD_INT_TYPE); 802dee8268fSThierry Reding DUMP_REG(DC_CMD_INT_POLARITY); 803dee8268fSThierry Reding DUMP_REG(DC_CMD_SIGNAL_RAISE1); 804dee8268fSThierry Reding DUMP_REG(DC_CMD_SIGNAL_RAISE2); 805dee8268fSThierry Reding DUMP_REG(DC_CMD_SIGNAL_RAISE3); 806dee8268fSThierry Reding DUMP_REG(DC_CMD_STATE_ACCESS); 807dee8268fSThierry Reding DUMP_REG(DC_CMD_STATE_CONTROL); 808dee8268fSThierry Reding DUMP_REG(DC_CMD_DISPLAY_WINDOW_HEADER); 809dee8268fSThierry Reding DUMP_REG(DC_CMD_REG_ACT_CONTROL); 810dee8268fSThierry Reding DUMP_REG(DC_COM_CRC_CONTROL); 811dee8268fSThierry Reding DUMP_REG(DC_COM_CRC_CHECKSUM); 812dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_ENABLE(0)); 813dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_ENABLE(1)); 814dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_ENABLE(2)); 815dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_ENABLE(3)); 816dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_POLARITY(0)); 817dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_POLARITY(1)); 818dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_POLARITY(2)); 819dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_POLARITY(3)); 820dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_DATA(0)); 821dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_DATA(1)); 822dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_DATA(2)); 823dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_DATA(3)); 824dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_INPUT_ENABLE(0)); 825dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_INPUT_ENABLE(1)); 826dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_INPUT_ENABLE(2)); 827dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_INPUT_ENABLE(3)); 828dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_INPUT_DATA(0)); 829dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_INPUT_DATA(1)); 830dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_SELECT(0)); 831dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_SELECT(1)); 832dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_SELECT(2)); 833dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_SELECT(3)); 834dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_SELECT(4)); 835dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_SELECT(5)); 836dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_OUTPUT_SELECT(6)); 837dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_MISC_CONTROL); 838dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_PM0_CONTROL); 839dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_PM0_DUTY_CYCLE); 840dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_PM1_CONTROL); 841dee8268fSThierry Reding DUMP_REG(DC_COM_PIN_PM1_DUTY_CYCLE); 842dee8268fSThierry Reding DUMP_REG(DC_COM_SPI_CONTROL); 843dee8268fSThierry Reding DUMP_REG(DC_COM_SPI_START_BYTE); 844dee8268fSThierry Reding DUMP_REG(DC_COM_HSPI_WRITE_DATA_AB); 845dee8268fSThierry Reding DUMP_REG(DC_COM_HSPI_WRITE_DATA_CD); 846dee8268fSThierry Reding DUMP_REG(DC_COM_HSPI_CS_DC); 847dee8268fSThierry Reding DUMP_REG(DC_COM_SCRATCH_REGISTER_A); 848dee8268fSThierry Reding DUMP_REG(DC_COM_SCRATCH_REGISTER_B); 849dee8268fSThierry Reding DUMP_REG(DC_COM_GPIO_CTRL); 850dee8268fSThierry Reding DUMP_REG(DC_COM_GPIO_DEBOUNCE_COUNTER); 851dee8268fSThierry Reding DUMP_REG(DC_COM_CRC_CHECKSUM_LATCHED); 852dee8268fSThierry Reding DUMP_REG(DC_DISP_DISP_SIGNAL_OPTIONS0); 853dee8268fSThierry Reding DUMP_REG(DC_DISP_DISP_SIGNAL_OPTIONS1); 854dee8268fSThierry Reding DUMP_REG(DC_DISP_DISP_WIN_OPTIONS); 855dee8268fSThierry Reding DUMP_REG(DC_DISP_DISP_MEM_HIGH_PRIORITY); 856dee8268fSThierry Reding DUMP_REG(DC_DISP_DISP_MEM_HIGH_PRIORITY_TIMER); 857dee8268fSThierry Reding DUMP_REG(DC_DISP_DISP_TIMING_OPTIONS); 858dee8268fSThierry Reding DUMP_REG(DC_DISP_REF_TO_SYNC); 859dee8268fSThierry Reding DUMP_REG(DC_DISP_SYNC_WIDTH); 860dee8268fSThierry Reding DUMP_REG(DC_DISP_BACK_PORCH); 861dee8268fSThierry Reding DUMP_REG(DC_DISP_ACTIVE); 862dee8268fSThierry Reding DUMP_REG(DC_DISP_FRONT_PORCH); 863dee8268fSThierry Reding DUMP_REG(DC_DISP_H_PULSE0_CONTROL); 864dee8268fSThierry Reding DUMP_REG(DC_DISP_H_PULSE0_POSITION_A); 865dee8268fSThierry Reding DUMP_REG(DC_DISP_H_PULSE0_POSITION_B); 866dee8268fSThierry Reding DUMP_REG(DC_DISP_H_PULSE0_POSITION_C); 867dee8268fSThierry Reding DUMP_REG(DC_DISP_H_PULSE0_POSITION_D); 868dee8268fSThierry Reding DUMP_REG(DC_DISP_H_PULSE1_CONTROL); 869dee8268fSThierry Reding DUMP_REG(DC_DISP_H_PULSE1_POSITION_A); 870dee8268fSThierry Reding DUMP_REG(DC_DISP_H_PULSE1_POSITION_B); 871dee8268fSThierry Reding DUMP_REG(DC_DISP_H_PULSE1_POSITION_C); 872dee8268fSThierry Reding DUMP_REG(DC_DISP_H_PULSE1_POSITION_D); 873dee8268fSThierry Reding DUMP_REG(DC_DISP_H_PULSE2_CONTROL); 874dee8268fSThierry Reding DUMP_REG(DC_DISP_H_PULSE2_POSITION_A); 875dee8268fSThierry Reding DUMP_REG(DC_DISP_H_PULSE2_POSITION_B); 876dee8268fSThierry Reding DUMP_REG(DC_DISP_H_PULSE2_POSITION_C); 877dee8268fSThierry Reding DUMP_REG(DC_DISP_H_PULSE2_POSITION_D); 878dee8268fSThierry Reding DUMP_REG(DC_DISP_V_PULSE0_CONTROL); 879dee8268fSThierry Reding DUMP_REG(DC_DISP_V_PULSE0_POSITION_A); 880dee8268fSThierry Reding DUMP_REG(DC_DISP_V_PULSE0_POSITION_B); 881dee8268fSThierry Reding DUMP_REG(DC_DISP_V_PULSE0_POSITION_C); 882dee8268fSThierry Reding DUMP_REG(DC_DISP_V_PULSE1_CONTROL); 883dee8268fSThierry Reding DUMP_REG(DC_DISP_V_PULSE1_POSITION_A); 884dee8268fSThierry Reding DUMP_REG(DC_DISP_V_PULSE1_POSITION_B); 885dee8268fSThierry Reding DUMP_REG(DC_DISP_V_PULSE1_POSITION_C); 886dee8268fSThierry Reding DUMP_REG(DC_DISP_V_PULSE2_CONTROL); 887dee8268fSThierry Reding DUMP_REG(DC_DISP_V_PULSE2_POSITION_A); 888dee8268fSThierry Reding DUMP_REG(DC_DISP_V_PULSE3_CONTROL); 889dee8268fSThierry Reding DUMP_REG(DC_DISP_V_PULSE3_POSITION_A); 890dee8268fSThierry Reding DUMP_REG(DC_DISP_M0_CONTROL); 891dee8268fSThierry Reding DUMP_REG(DC_DISP_M1_CONTROL); 892dee8268fSThierry Reding DUMP_REG(DC_DISP_DI_CONTROL); 893dee8268fSThierry Reding DUMP_REG(DC_DISP_PP_CONTROL); 894dee8268fSThierry Reding DUMP_REG(DC_DISP_PP_SELECT_A); 895dee8268fSThierry Reding DUMP_REG(DC_DISP_PP_SELECT_B); 896dee8268fSThierry Reding DUMP_REG(DC_DISP_PP_SELECT_C); 897dee8268fSThierry Reding DUMP_REG(DC_DISP_PP_SELECT_D); 898dee8268fSThierry Reding DUMP_REG(DC_DISP_DISP_CLOCK_CONTROL); 899dee8268fSThierry Reding DUMP_REG(DC_DISP_DISP_INTERFACE_CONTROL); 900dee8268fSThierry Reding DUMP_REG(DC_DISP_DISP_COLOR_CONTROL); 901dee8268fSThierry Reding DUMP_REG(DC_DISP_SHIFT_CLOCK_OPTIONS); 902dee8268fSThierry Reding DUMP_REG(DC_DISP_DATA_ENABLE_OPTIONS); 903dee8268fSThierry Reding DUMP_REG(DC_DISP_SERIAL_INTERFACE_OPTIONS); 904dee8268fSThierry Reding DUMP_REG(DC_DISP_LCD_SPI_OPTIONS); 905dee8268fSThierry Reding DUMP_REG(DC_DISP_BORDER_COLOR); 906dee8268fSThierry Reding DUMP_REG(DC_DISP_COLOR_KEY0_LOWER); 907dee8268fSThierry Reding DUMP_REG(DC_DISP_COLOR_KEY0_UPPER); 908dee8268fSThierry Reding DUMP_REG(DC_DISP_COLOR_KEY1_LOWER); 909dee8268fSThierry Reding DUMP_REG(DC_DISP_COLOR_KEY1_UPPER); 910dee8268fSThierry Reding DUMP_REG(DC_DISP_CURSOR_FOREGROUND); 911dee8268fSThierry Reding DUMP_REG(DC_DISP_CURSOR_BACKGROUND); 912dee8268fSThierry Reding DUMP_REG(DC_DISP_CURSOR_START_ADDR); 913dee8268fSThierry Reding DUMP_REG(DC_DISP_CURSOR_START_ADDR_NS); 914dee8268fSThierry Reding DUMP_REG(DC_DISP_CURSOR_POSITION); 915dee8268fSThierry Reding DUMP_REG(DC_DISP_CURSOR_POSITION_NS); 916dee8268fSThierry Reding DUMP_REG(DC_DISP_INIT_SEQ_CONTROL); 917dee8268fSThierry Reding DUMP_REG(DC_DISP_SPI_INIT_SEQ_DATA_A); 918dee8268fSThierry Reding DUMP_REG(DC_DISP_SPI_INIT_SEQ_DATA_B); 919dee8268fSThierry Reding DUMP_REG(DC_DISP_SPI_INIT_SEQ_DATA_C); 920dee8268fSThierry Reding DUMP_REG(DC_DISP_SPI_INIT_SEQ_DATA_D); 921dee8268fSThierry Reding DUMP_REG(DC_DISP_DC_MCCIF_FIFOCTRL); 922dee8268fSThierry Reding DUMP_REG(DC_DISP_MCCIF_DISPLAY0A_HYST); 923dee8268fSThierry Reding DUMP_REG(DC_DISP_MCCIF_DISPLAY0B_HYST); 924dee8268fSThierry Reding DUMP_REG(DC_DISP_MCCIF_DISPLAY1A_HYST); 925dee8268fSThierry Reding DUMP_REG(DC_DISP_MCCIF_DISPLAY1B_HYST); 926dee8268fSThierry Reding DUMP_REG(DC_DISP_DAC_CRT_CTRL); 927dee8268fSThierry Reding DUMP_REG(DC_DISP_DISP_MISC_CONTROL); 928dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_CONTROL); 929dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_CSC_COEFF); 930dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_LUT(0)); 931dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_LUT(1)); 932dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_LUT(2)); 933dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_LUT(3)); 934dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_LUT(4)); 935dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_LUT(5)); 936dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_LUT(6)); 937dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_LUT(7)); 938dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_LUT(8)); 939dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_FLICKER_CONTROL); 940dee8268fSThierry Reding DUMP_REG(DC_DISP_DC_PIXEL_COUNT); 941dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_HISTOGRAM(0)); 942dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_HISTOGRAM(1)); 943dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_HISTOGRAM(2)); 944dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_HISTOGRAM(3)); 945dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_HISTOGRAM(4)); 946dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_HISTOGRAM(5)); 947dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_HISTOGRAM(6)); 948dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_HISTOGRAM(7)); 949dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_BL_TF(0)); 950dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_BL_TF(1)); 951dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_BL_TF(2)); 952dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_BL_TF(3)); 953dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_BL_CONTROL); 954dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_HW_K_VALUES); 955dee8268fSThierry Reding DUMP_REG(DC_DISP_SD_MAN_K_VALUES); 956dee8268fSThierry Reding DUMP_REG(DC_WIN_WIN_OPTIONS); 957dee8268fSThierry Reding DUMP_REG(DC_WIN_BYTE_SWAP); 958dee8268fSThierry Reding DUMP_REG(DC_WIN_BUFFER_CONTROL); 959dee8268fSThierry Reding DUMP_REG(DC_WIN_COLOR_DEPTH); 960dee8268fSThierry Reding DUMP_REG(DC_WIN_POSITION); 961dee8268fSThierry Reding DUMP_REG(DC_WIN_SIZE); 962dee8268fSThierry Reding DUMP_REG(DC_WIN_PRESCALED_SIZE); 963dee8268fSThierry Reding DUMP_REG(DC_WIN_H_INITIAL_DDA); 964dee8268fSThierry Reding DUMP_REG(DC_WIN_V_INITIAL_DDA); 965dee8268fSThierry Reding DUMP_REG(DC_WIN_DDA_INC); 966dee8268fSThierry Reding DUMP_REG(DC_WIN_LINE_STRIDE); 967dee8268fSThierry Reding DUMP_REG(DC_WIN_BUF_STRIDE); 968dee8268fSThierry Reding DUMP_REG(DC_WIN_UV_BUF_STRIDE); 969dee8268fSThierry Reding DUMP_REG(DC_WIN_BUFFER_ADDR_MODE); 970dee8268fSThierry Reding DUMP_REG(DC_WIN_DV_CONTROL); 971dee8268fSThierry Reding DUMP_REG(DC_WIN_BLEND_NOKEY); 972dee8268fSThierry Reding DUMP_REG(DC_WIN_BLEND_1WIN); 973dee8268fSThierry Reding DUMP_REG(DC_WIN_BLEND_2WIN_X); 974dee8268fSThierry Reding DUMP_REG(DC_WIN_BLEND_2WIN_Y); 975dee8268fSThierry Reding DUMP_REG(DC_WIN_BLEND_3WIN_XY); 976dee8268fSThierry Reding DUMP_REG(DC_WIN_HP_FETCH_CONTROL); 977dee8268fSThierry Reding DUMP_REG(DC_WINBUF_START_ADDR); 978dee8268fSThierry Reding DUMP_REG(DC_WINBUF_START_ADDR_NS); 979dee8268fSThierry Reding DUMP_REG(DC_WINBUF_START_ADDR_U); 980dee8268fSThierry Reding DUMP_REG(DC_WINBUF_START_ADDR_U_NS); 981dee8268fSThierry Reding DUMP_REG(DC_WINBUF_START_ADDR_V); 982dee8268fSThierry Reding DUMP_REG(DC_WINBUF_START_ADDR_V_NS); 983dee8268fSThierry Reding DUMP_REG(DC_WINBUF_ADDR_H_OFFSET); 984dee8268fSThierry Reding DUMP_REG(DC_WINBUF_ADDR_H_OFFSET_NS); 985dee8268fSThierry Reding DUMP_REG(DC_WINBUF_ADDR_V_OFFSET); 986dee8268fSThierry Reding DUMP_REG(DC_WINBUF_ADDR_V_OFFSET_NS); 987dee8268fSThierry Reding DUMP_REG(DC_WINBUF_UFLOW_STATUS); 988dee8268fSThierry Reding DUMP_REG(DC_WINBUF_AD_UFLOW_STATUS); 989dee8268fSThierry Reding DUMP_REG(DC_WINBUF_BD_UFLOW_STATUS); 990dee8268fSThierry Reding DUMP_REG(DC_WINBUF_CD_UFLOW_STATUS); 991dee8268fSThierry Reding 992dee8268fSThierry Reding #undef DUMP_REG 993dee8268fSThierry Reding 994dee8268fSThierry Reding return 0; 995dee8268fSThierry Reding } 996dee8268fSThierry Reding 997dee8268fSThierry Reding static struct drm_info_list debugfs_files[] = { 998dee8268fSThierry Reding { "regs", tegra_dc_show_regs, 0, NULL }, 999dee8268fSThierry Reding }; 1000dee8268fSThierry Reding 1001dee8268fSThierry Reding static int tegra_dc_debugfs_init(struct tegra_dc *dc, struct drm_minor *minor) 1002dee8268fSThierry Reding { 1003dee8268fSThierry Reding unsigned int i; 1004dee8268fSThierry Reding char *name; 1005dee8268fSThierry Reding int err; 1006dee8268fSThierry Reding 1007dee8268fSThierry Reding name = kasprintf(GFP_KERNEL, "dc.%d", dc->pipe); 1008dee8268fSThierry Reding dc->debugfs = debugfs_create_dir(name, minor->debugfs_root); 1009dee8268fSThierry Reding kfree(name); 1010dee8268fSThierry Reding 1011dee8268fSThierry Reding if (!dc->debugfs) 1012dee8268fSThierry Reding return -ENOMEM; 1013dee8268fSThierry Reding 1014dee8268fSThierry Reding dc->debugfs_files = kmemdup(debugfs_files, sizeof(debugfs_files), 1015dee8268fSThierry Reding GFP_KERNEL); 1016dee8268fSThierry Reding if (!dc->debugfs_files) { 1017dee8268fSThierry Reding err = -ENOMEM; 1018dee8268fSThierry Reding goto remove; 1019dee8268fSThierry Reding } 1020dee8268fSThierry Reding 1021dee8268fSThierry Reding for (i = 0; i < ARRAY_SIZE(debugfs_files); i++) 1022dee8268fSThierry Reding dc->debugfs_files[i].data = dc; 1023dee8268fSThierry Reding 1024dee8268fSThierry Reding err = drm_debugfs_create_files(dc->debugfs_files, 1025dee8268fSThierry Reding ARRAY_SIZE(debugfs_files), 1026dee8268fSThierry Reding dc->debugfs, minor); 1027dee8268fSThierry Reding if (err < 0) 1028dee8268fSThierry Reding goto free; 1029dee8268fSThierry Reding 1030dee8268fSThierry Reding dc->minor = minor; 1031dee8268fSThierry Reding 1032dee8268fSThierry Reding return 0; 1033dee8268fSThierry Reding 1034dee8268fSThierry Reding free: 1035dee8268fSThierry Reding kfree(dc->debugfs_files); 1036dee8268fSThierry Reding dc->debugfs_files = NULL; 1037dee8268fSThierry Reding remove: 1038dee8268fSThierry Reding debugfs_remove(dc->debugfs); 1039dee8268fSThierry Reding dc->debugfs = NULL; 1040dee8268fSThierry Reding 1041dee8268fSThierry Reding return err; 1042dee8268fSThierry Reding } 1043dee8268fSThierry Reding 1044dee8268fSThierry Reding static int tegra_dc_debugfs_exit(struct tegra_dc *dc) 1045dee8268fSThierry Reding { 1046dee8268fSThierry Reding drm_debugfs_remove_files(dc->debugfs_files, ARRAY_SIZE(debugfs_files), 1047dee8268fSThierry Reding dc->minor); 1048dee8268fSThierry Reding dc->minor = NULL; 1049dee8268fSThierry Reding 1050dee8268fSThierry Reding kfree(dc->debugfs_files); 1051dee8268fSThierry Reding dc->debugfs_files = NULL; 1052dee8268fSThierry Reding 1053dee8268fSThierry Reding debugfs_remove(dc->debugfs); 1054dee8268fSThierry Reding dc->debugfs = NULL; 1055dee8268fSThierry Reding 1056dee8268fSThierry Reding return 0; 1057dee8268fSThierry Reding } 1058dee8268fSThierry Reding 1059dee8268fSThierry Reding static int tegra_dc_init(struct host1x_client *client) 1060dee8268fSThierry Reding { 1061dee8268fSThierry Reding struct tegra_drm *tegra = dev_get_drvdata(client->parent); 1062dee8268fSThierry Reding struct tegra_dc *dc = host1x_client_to_dc(client); 1063dee8268fSThierry Reding int err; 1064dee8268fSThierry Reding 1065dee8268fSThierry Reding dc->pipe = tegra->drm->mode_config.num_crtc; 1066dee8268fSThierry Reding 1067dee8268fSThierry Reding drm_crtc_init(tegra->drm, &dc->base, &tegra_crtc_funcs); 1068dee8268fSThierry Reding drm_mode_crtc_set_gamma_size(&dc->base, 256); 1069dee8268fSThierry Reding drm_crtc_helper_add(&dc->base, &tegra_crtc_helper_funcs); 1070dee8268fSThierry Reding 1071dee8268fSThierry Reding err = tegra_dc_rgb_init(tegra->drm, dc); 1072dee8268fSThierry Reding if (err < 0 && err != -ENODEV) { 1073dee8268fSThierry Reding dev_err(dc->dev, "failed to initialize RGB output: %d\n", err); 1074dee8268fSThierry Reding return err; 1075dee8268fSThierry Reding } 1076dee8268fSThierry Reding 1077dee8268fSThierry Reding err = tegra_dc_add_planes(tegra->drm, dc); 1078dee8268fSThierry Reding if (err < 0) 1079dee8268fSThierry Reding return err; 1080dee8268fSThierry Reding 1081dee8268fSThierry Reding if (IS_ENABLED(CONFIG_DEBUG_FS)) { 1082dee8268fSThierry Reding err = tegra_dc_debugfs_init(dc, tegra->drm->primary); 1083dee8268fSThierry Reding if (err < 0) 1084dee8268fSThierry Reding dev_err(dc->dev, "debugfs setup failed: %d\n", err); 1085dee8268fSThierry Reding } 1086dee8268fSThierry Reding 1087dee8268fSThierry Reding err = devm_request_irq(dc->dev, dc->irq, tegra_dc_irq, 0, 1088dee8268fSThierry Reding dev_name(dc->dev), dc); 1089dee8268fSThierry Reding if (err < 0) { 1090dee8268fSThierry Reding dev_err(dc->dev, "failed to request IRQ#%u: %d\n", dc->irq, 1091dee8268fSThierry Reding err); 1092dee8268fSThierry Reding return err; 1093dee8268fSThierry Reding } 1094dee8268fSThierry Reding 1095dee8268fSThierry Reding return 0; 1096dee8268fSThierry Reding } 1097dee8268fSThierry Reding 1098dee8268fSThierry Reding static int tegra_dc_exit(struct host1x_client *client) 1099dee8268fSThierry Reding { 1100dee8268fSThierry Reding struct tegra_dc *dc = host1x_client_to_dc(client); 1101dee8268fSThierry Reding int err; 1102dee8268fSThierry Reding 1103dee8268fSThierry Reding devm_free_irq(dc->dev, dc->irq, dc); 1104dee8268fSThierry Reding 1105dee8268fSThierry Reding if (IS_ENABLED(CONFIG_DEBUG_FS)) { 1106dee8268fSThierry Reding err = tegra_dc_debugfs_exit(dc); 1107dee8268fSThierry Reding if (err < 0) 1108dee8268fSThierry Reding dev_err(dc->dev, "debugfs cleanup failed: %d\n", err); 1109dee8268fSThierry Reding } 1110dee8268fSThierry Reding 1111dee8268fSThierry Reding err = tegra_dc_rgb_exit(dc); 1112dee8268fSThierry Reding if (err) { 1113dee8268fSThierry Reding dev_err(dc->dev, "failed to shutdown RGB output: %d\n", err); 1114dee8268fSThierry Reding return err; 1115dee8268fSThierry Reding } 1116dee8268fSThierry Reding 1117dee8268fSThierry Reding return 0; 1118dee8268fSThierry Reding } 1119dee8268fSThierry Reding 1120dee8268fSThierry Reding static const struct host1x_client_ops dc_client_ops = { 1121dee8268fSThierry Reding .init = tegra_dc_init, 1122dee8268fSThierry Reding .exit = tegra_dc_exit, 1123dee8268fSThierry Reding }; 1124dee8268fSThierry Reding 1125dee8268fSThierry Reding static int tegra_dc_probe(struct platform_device *pdev) 1126dee8268fSThierry Reding { 1127dee8268fSThierry Reding struct resource *regs; 1128dee8268fSThierry Reding struct tegra_dc *dc; 1129dee8268fSThierry Reding int err; 1130dee8268fSThierry Reding 1131dee8268fSThierry Reding dc = devm_kzalloc(&pdev->dev, sizeof(*dc), GFP_KERNEL); 1132dee8268fSThierry Reding if (!dc) 1133dee8268fSThierry Reding return -ENOMEM; 1134dee8268fSThierry Reding 1135dee8268fSThierry Reding spin_lock_init(&dc->lock); 1136dee8268fSThierry Reding INIT_LIST_HEAD(&dc->list); 1137dee8268fSThierry Reding dc->dev = &pdev->dev; 1138dee8268fSThierry Reding 1139dee8268fSThierry Reding dc->clk = devm_clk_get(&pdev->dev, NULL); 1140dee8268fSThierry Reding if (IS_ERR(dc->clk)) { 1141dee8268fSThierry Reding dev_err(&pdev->dev, "failed to get clock\n"); 1142dee8268fSThierry Reding return PTR_ERR(dc->clk); 1143dee8268fSThierry Reding } 1144dee8268fSThierry Reding 1145dee8268fSThierry Reding err = clk_prepare_enable(dc->clk); 1146dee8268fSThierry Reding if (err < 0) 1147dee8268fSThierry Reding return err; 1148dee8268fSThierry Reding 1149dee8268fSThierry Reding regs = platform_get_resource(pdev, IORESOURCE_MEM, 0); 1150dee8268fSThierry Reding dc->regs = devm_ioremap_resource(&pdev->dev, regs); 1151dee8268fSThierry Reding if (IS_ERR(dc->regs)) 1152dee8268fSThierry Reding return PTR_ERR(dc->regs); 1153dee8268fSThierry Reding 1154dee8268fSThierry Reding dc->irq = platform_get_irq(pdev, 0); 1155dee8268fSThierry Reding if (dc->irq < 0) { 1156dee8268fSThierry Reding dev_err(&pdev->dev, "failed to get IRQ\n"); 1157dee8268fSThierry Reding return -ENXIO; 1158dee8268fSThierry Reding } 1159dee8268fSThierry Reding 1160dee8268fSThierry Reding INIT_LIST_HEAD(&dc->client.list); 1161dee8268fSThierry Reding dc->client.ops = &dc_client_ops; 1162dee8268fSThierry Reding dc->client.dev = &pdev->dev; 1163dee8268fSThierry Reding 1164dee8268fSThierry Reding err = tegra_dc_rgb_probe(dc); 1165dee8268fSThierry Reding if (err < 0 && err != -ENODEV) { 1166dee8268fSThierry Reding dev_err(&pdev->dev, "failed to probe RGB output: %d\n", err); 1167dee8268fSThierry Reding return err; 1168dee8268fSThierry Reding } 1169dee8268fSThierry Reding 1170dee8268fSThierry Reding err = host1x_client_register(&dc->client); 1171dee8268fSThierry Reding if (err < 0) { 1172dee8268fSThierry Reding dev_err(&pdev->dev, "failed to register host1x client: %d\n", 1173dee8268fSThierry Reding err); 1174dee8268fSThierry Reding return err; 1175dee8268fSThierry Reding } 1176dee8268fSThierry Reding 1177dee8268fSThierry Reding platform_set_drvdata(pdev, dc); 1178dee8268fSThierry Reding 1179dee8268fSThierry Reding return 0; 1180dee8268fSThierry Reding } 1181dee8268fSThierry Reding 1182dee8268fSThierry Reding static int tegra_dc_remove(struct platform_device *pdev) 1183dee8268fSThierry Reding { 1184dee8268fSThierry Reding struct tegra_dc *dc = platform_get_drvdata(pdev); 1185dee8268fSThierry Reding int err; 1186dee8268fSThierry Reding 1187dee8268fSThierry Reding err = host1x_client_unregister(&dc->client); 1188dee8268fSThierry Reding if (err < 0) { 1189dee8268fSThierry Reding dev_err(&pdev->dev, "failed to unregister host1x client: %d\n", 1190dee8268fSThierry Reding err); 1191dee8268fSThierry Reding return err; 1192dee8268fSThierry Reding } 1193dee8268fSThierry Reding 1194dee8268fSThierry Reding clk_disable_unprepare(dc->clk); 1195dee8268fSThierry Reding 1196dee8268fSThierry Reding return 0; 1197dee8268fSThierry Reding } 1198dee8268fSThierry Reding 1199dee8268fSThierry Reding static struct of_device_id tegra_dc_of_match[] = { 1200dee8268fSThierry Reding { .compatible = "nvidia,tegra30-dc", }, 1201dee8268fSThierry Reding { .compatible = "nvidia,tegra20-dc", }, 1202dee8268fSThierry Reding { }, 1203dee8268fSThierry Reding }; 1204dee8268fSThierry Reding 1205dee8268fSThierry Reding struct platform_driver tegra_dc_driver = { 1206dee8268fSThierry Reding .driver = { 1207dee8268fSThierry Reding .name = "tegra-dc", 1208dee8268fSThierry Reding .owner = THIS_MODULE, 1209dee8268fSThierry Reding .of_match_table = tegra_dc_of_match, 1210dee8268fSThierry Reding }, 1211dee8268fSThierry Reding .probe = tegra_dc_probe, 1212dee8268fSThierry Reding .remove = tegra_dc_remove, 1213dee8268fSThierry Reding }; 1214