linux/drivers/gpu/drm/atmel-hlcdc/atmel_hlcdc_dc.c
<<
>>
Prefs
   1/*
   2 * Copyright (C) 2014 Traphandler
   3 * Copyright (C) 2014 Free Electrons
   4 * Copyright (C) 2014 Atmel
   5 *
   6 * Author: Jean-Jacques Hiblot <jjhiblot@traphandler.com>
   7 * Author: Boris BREZILLON <boris.brezillon@free-electrons.com>
   8 *
   9 * This program is free software; you can redistribute it and/or modify it
  10 * under the terms of the GNU General Public License version 2 as published by
  11 * the Free Software Foundation.
  12 *
  13 * This program is distributed in the hope that it will be useful, but WITHOUT
  14 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  15 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  16 * more details.
  17 *
  18 * You should have received a copy of the GNU General Public License along with
  19 * this program.  If not, see <http://www.gnu.org/licenses/>.
  20 */
  21
  22#include <linux/clk.h>
  23#include <linux/irq.h>
  24#include <linux/irqchip.h>
  25#include <linux/module.h>
  26#include <linux/pm_runtime.h>
  27
  28#include "atmel_hlcdc_dc.h"
  29
  30#define ATMEL_HLCDC_LAYER_IRQS_OFFSET           8
  31
  32static const struct atmel_hlcdc_layer_desc atmel_hlcdc_at91sam9n12_layers[] = {
  33        {
  34                .name = "base",
  35                .formats = &atmel_hlcdc_plane_rgb_formats,
  36                .regs_offset = 0x40,
  37                .id = 0,
  38                .type = ATMEL_HLCDC_BASE_LAYER,
  39                .cfgs_offset = 0x2c,
  40                .layout = {
  41                        .xstride = { 2 },
  42                        .default_color = 3,
  43                        .general_config = 4,
  44                },
  45                .clut_offset = 0x400,
  46        },
  47};
  48
  49static const struct atmel_hlcdc_dc_desc atmel_hlcdc_dc_at91sam9n12 = {
  50        .min_width = 0,
  51        .min_height = 0,
  52        .max_width = 1280,
  53        .max_height = 860,
  54        .max_spw = 0x3f,
  55        .max_vpw = 0x3f,
  56        .max_hpw = 0xff,
  57        .conflicting_output_formats = true,
  58        .nlayers = ARRAY_SIZE(atmel_hlcdc_at91sam9n12_layers),
  59        .layers = atmel_hlcdc_at91sam9n12_layers,
  60};
  61
  62static const struct atmel_hlcdc_layer_desc atmel_hlcdc_at91sam9x5_layers[] = {
  63        {
  64                .name = "base",
  65                .formats = &atmel_hlcdc_plane_rgb_formats,
  66                .regs_offset = 0x40,
  67                .id = 0,
  68                .type = ATMEL_HLCDC_BASE_LAYER,
  69                .cfgs_offset = 0x2c,
  70                .layout = {
  71                        .xstride = { 2 },
  72                        .default_color = 3,
  73                        .general_config = 4,
  74                        .disc_pos = 5,
  75                        .disc_size = 6,
  76                },
  77                .clut_offset = 0x400,
  78        },
  79        {
  80                .name = "overlay1",
  81                .formats = &atmel_hlcdc_plane_rgb_formats,
  82                .regs_offset = 0x100,
  83                .id = 1,
  84                .type = ATMEL_HLCDC_OVERLAY_LAYER,
  85                .cfgs_offset = 0x2c,
  86                .layout = {
  87                        .pos = 2,
  88                        .size = 3,
  89                        .xstride = { 4 },
  90                        .pstride = { 5 },
  91                        .default_color = 6,
  92                        .chroma_key = 7,
  93                        .chroma_key_mask = 8,
  94                        .general_config = 9,
  95                },
  96                .clut_offset = 0x800,
  97        },
  98        {
  99                .name = "high-end-overlay",
 100                .formats = &atmel_hlcdc_plane_rgb_and_yuv_formats,
 101                .regs_offset = 0x280,
 102                .id = 2,
 103                .type = ATMEL_HLCDC_OVERLAY_LAYER,
 104                .cfgs_offset = 0x4c,
 105                .layout = {
 106                        .pos = 2,
 107                        .size = 3,
 108                        .memsize = 4,
 109                        .xstride = { 5, 7 },
 110                        .pstride = { 6, 8 },
 111                        .default_color = 9,
 112                        .chroma_key = 10,
 113                        .chroma_key_mask = 11,
 114                        .general_config = 12,
 115                        .scaler_config = 13,
 116                        .csc = 14,
 117                },
 118                .clut_offset = 0x1000,
 119        },
 120        {
 121                .name = "cursor",
 122                .formats = &atmel_hlcdc_plane_rgb_formats,
 123                .regs_offset = 0x340,
 124                .id = 3,
 125                .type = ATMEL_HLCDC_CURSOR_LAYER,
 126                .max_width = 128,
 127                .max_height = 128,
 128                .cfgs_offset = 0x2c,
 129                .layout = {
 130                        .pos = 2,
 131                        .size = 3,
 132                        .xstride = { 4 },
 133                        .default_color = 6,
 134                        .chroma_key = 7,
 135                        .chroma_key_mask = 8,
 136                        .general_config = 9,
 137                },
 138                .clut_offset = 0x1400,
 139        },
 140};
 141
 142static const struct atmel_hlcdc_dc_desc atmel_hlcdc_dc_at91sam9x5 = {
 143        .min_width = 0,
 144        .min_height = 0,
 145        .max_width = 800,
 146        .max_height = 600,
 147        .max_spw = 0x3f,
 148        .max_vpw = 0x3f,
 149        .max_hpw = 0xff,
 150        .conflicting_output_formats = true,
 151        .nlayers = ARRAY_SIZE(atmel_hlcdc_at91sam9x5_layers),
 152        .layers = atmel_hlcdc_at91sam9x5_layers,
 153};
 154
 155static const struct atmel_hlcdc_layer_desc atmel_hlcdc_sama5d3_layers[] = {
 156        {
 157                .name = "base",
 158                .formats = &atmel_hlcdc_plane_rgb_formats,
 159                .regs_offset = 0x40,
 160                .id = 0,
 161                .type = ATMEL_HLCDC_BASE_LAYER,
 162                .cfgs_offset = 0x2c,
 163                .layout = {
 164                        .xstride = { 2 },
 165                        .default_color = 3,
 166                        .general_config = 4,
 167                        .disc_pos = 5,
 168                        .disc_size = 6,
 169                },
 170                .clut_offset = 0x600,
 171        },
 172        {
 173                .name = "overlay1",
 174                .formats = &atmel_hlcdc_plane_rgb_formats,
 175                .regs_offset = 0x140,
 176                .id = 1,
 177                .type = ATMEL_HLCDC_OVERLAY_LAYER,
 178                .cfgs_offset = 0x2c,
 179                .layout = {
 180                        .pos = 2,
 181                        .size = 3,
 182                        .xstride = { 4 },
 183                        .pstride = { 5 },
 184                        .default_color = 6,
 185                        .chroma_key = 7,
 186                        .chroma_key_mask = 8,
 187                        .general_config = 9,
 188                },
 189                .clut_offset = 0xa00,
 190        },
 191        {
 192                .name = "overlay2",
 193                .formats = &atmel_hlcdc_plane_rgb_formats,
 194                .regs_offset = 0x240,
 195                .id = 2,
 196                .type = ATMEL_HLCDC_OVERLAY_LAYER,
 197                .cfgs_offset = 0x2c,
 198                .layout = {
 199                        .pos = 2,
 200                        .size = 3,
 201                        .xstride = { 4 },
 202                        .pstride = { 5 },
 203                        .default_color = 6,
 204                        .chroma_key = 7,
 205                        .chroma_key_mask = 8,
 206                        .general_config = 9,
 207                },
 208                .clut_offset = 0xe00,
 209        },
 210        {
 211                .name = "high-end-overlay",
 212                .formats = &atmel_hlcdc_plane_rgb_and_yuv_formats,
 213                .regs_offset = 0x340,
 214                .id = 3,
 215                .type = ATMEL_HLCDC_OVERLAY_LAYER,
 216                .cfgs_offset = 0x4c,
 217                .layout = {
 218                        .pos = 2,
 219                        .size = 3,
 220                        .memsize = 4,
 221                        .xstride = { 5, 7 },
 222                        .pstride = { 6, 8 },
 223                        .default_color = 9,
 224                        .chroma_key = 10,
 225                        .chroma_key_mask = 11,
 226                        .general_config = 12,
 227                        .scaler_config = 13,
 228                        .phicoeffs = {
 229                                .x = 17,
 230                                .y = 33,
 231                        },
 232                        .csc = 14,
 233                },
 234                .clut_offset = 0x1200,
 235        },
 236        {
 237                .name = "cursor",
 238                .formats = &atmel_hlcdc_plane_rgb_formats,
 239                .regs_offset = 0x440,
 240                .id = 4,
 241                .type = ATMEL_HLCDC_CURSOR_LAYER,
 242                .max_width = 128,
 243                .max_height = 128,
 244                .cfgs_offset = 0x2c,
 245                .layout = {
 246                        .pos = 2,
 247                        .size = 3,
 248                        .xstride = { 4 },
 249                        .pstride = { 5 },
 250                        .default_color = 6,
 251                        .chroma_key = 7,
 252                        .chroma_key_mask = 8,
 253                        .general_config = 9,
 254                        .scaler_config = 13,
 255                },
 256                .clut_offset = 0x1600,
 257        },
 258};
 259
 260static const struct atmel_hlcdc_dc_desc atmel_hlcdc_dc_sama5d3 = {
 261        .min_width = 0,
 262        .min_height = 0,
 263        .max_width = 2048,
 264        .max_height = 2048,
 265        .max_spw = 0x3f,
 266        .max_vpw = 0x3f,
 267        .max_hpw = 0x1ff,
 268        .conflicting_output_formats = true,
 269        .nlayers = ARRAY_SIZE(atmel_hlcdc_sama5d3_layers),
 270        .layers = atmel_hlcdc_sama5d3_layers,
 271};
 272
 273static const struct atmel_hlcdc_layer_desc atmel_hlcdc_sama5d4_layers[] = {
 274        {
 275                .name = "base",
 276                .formats = &atmel_hlcdc_plane_rgb_formats,
 277                .regs_offset = 0x40,
 278                .id = 0,
 279                .type = ATMEL_HLCDC_BASE_LAYER,
 280                .cfgs_offset = 0x2c,
 281                .layout = {
 282                        .xstride = { 2 },
 283                        .default_color = 3,
 284                        .general_config = 4,
 285                        .disc_pos = 5,
 286                        .disc_size = 6,
 287                },
 288                .clut_offset = 0x600,
 289        },
 290        {
 291                .name = "overlay1",
 292                .formats = &atmel_hlcdc_plane_rgb_formats,
 293                .regs_offset = 0x140,
 294                .id = 1,
 295                .type = ATMEL_HLCDC_OVERLAY_LAYER,
 296                .cfgs_offset = 0x2c,
 297                .layout = {
 298                        .pos = 2,
 299                        .size = 3,
 300                        .xstride = { 4 },
 301                        .pstride = { 5 },
 302                        .default_color = 6,
 303                        .chroma_key = 7,
 304                        .chroma_key_mask = 8,
 305                        .general_config = 9,
 306                },
 307                .clut_offset = 0xa00,
 308        },
 309        {
 310                .name = "overlay2",
 311                .formats = &atmel_hlcdc_plane_rgb_formats,
 312                .regs_offset = 0x240,
 313                .id = 2,
 314                .type = ATMEL_HLCDC_OVERLAY_LAYER,
 315                .cfgs_offset = 0x2c,
 316                .layout = {
 317                        .pos = 2,
 318                        .size = 3,
 319                        .xstride = { 4 },
 320                        .pstride = { 5 },
 321                        .default_color = 6,
 322                        .chroma_key = 7,
 323                        .chroma_key_mask = 8,
 324                        .general_config = 9,
 325                },
 326                .clut_offset = 0xe00,
 327        },
 328        {
 329                .name = "high-end-overlay",
 330                .formats = &atmel_hlcdc_plane_rgb_and_yuv_formats,
 331                .regs_offset = 0x340,
 332                .id = 3,
 333                .type = ATMEL_HLCDC_OVERLAY_LAYER,
 334                .cfgs_offset = 0x4c,
 335                .layout = {
 336                        .pos = 2,
 337                        .size = 3,
 338                        .memsize = 4,
 339                        .xstride = { 5, 7 },
 340                        .pstride = { 6, 8 },
 341                        .default_color = 9,
 342                        .chroma_key = 10,
 343                        .chroma_key_mask = 11,
 344                        .general_config = 12,
 345                        .scaler_config = 13,
 346                        .phicoeffs = {
 347                                .x = 17,
 348                                .y = 33,
 349                        },
 350                        .csc = 14,
 351                },
 352                .clut_offset = 0x1200,
 353        },
 354};
 355
 356static const struct atmel_hlcdc_dc_desc atmel_hlcdc_dc_sama5d4 = {
 357        .min_width = 0,
 358        .min_height = 0,
 359        .max_width = 2048,
 360        .max_height = 2048,
 361        .max_spw = 0xff,
 362        .max_vpw = 0xff,
 363        .max_hpw = 0x3ff,
 364        .nlayers = ARRAY_SIZE(atmel_hlcdc_sama5d4_layers),
 365        .layers = atmel_hlcdc_sama5d4_layers,
 366};
 367static const struct of_device_id atmel_hlcdc_of_match[] = {
 368        {
 369                .compatible = "atmel,at91sam9n12-hlcdc",
 370                .data = &atmel_hlcdc_dc_at91sam9n12,
 371        },
 372        {
 373                .compatible = "atmel,at91sam9x5-hlcdc",
 374                .data = &atmel_hlcdc_dc_at91sam9x5,
 375        },
 376        {
 377                .compatible = "atmel,sama5d2-hlcdc",
 378                .data = &atmel_hlcdc_dc_sama5d4,
 379        },
 380        {
 381                .compatible = "atmel,sama5d3-hlcdc",
 382                .data = &atmel_hlcdc_dc_sama5d3,
 383        },
 384        {
 385                .compatible = "atmel,sama5d4-hlcdc",
 386                .data = &atmel_hlcdc_dc_sama5d4,
 387        },
 388        { /* sentinel */ },
 389};
 390MODULE_DEVICE_TABLE(of, atmel_hlcdc_of_match);
 391
 392enum drm_mode_status
 393atmel_hlcdc_dc_mode_valid(struct atmel_hlcdc_dc *dc,
 394                          const struct drm_display_mode *mode)
 395{
 396        int vfront_porch = mode->vsync_start - mode->vdisplay;
 397        int vback_porch = mode->vtotal - mode->vsync_end;
 398        int vsync_len = mode->vsync_end - mode->vsync_start;
 399        int hfront_porch = mode->hsync_start - mode->hdisplay;
 400        int hback_porch = mode->htotal - mode->hsync_end;
 401        int hsync_len = mode->hsync_end - mode->hsync_start;
 402
 403        if (hsync_len > dc->desc->max_spw + 1 || hsync_len < 1)
 404                return MODE_HSYNC;
 405
 406        if (vsync_len > dc->desc->max_spw + 1 || vsync_len < 1)
 407                return MODE_VSYNC;
 408
 409        if (hfront_porch > dc->desc->max_hpw + 1 || hfront_porch < 1 ||
 410            hback_porch > dc->desc->max_hpw + 1 || hback_porch < 1 ||
 411            mode->hdisplay < 1)
 412                return MODE_H_ILLEGAL;
 413
 414        if (vfront_porch > dc->desc->max_vpw + 1 || vfront_porch < 1 ||
 415            vback_porch > dc->desc->max_vpw || vback_porch < 0 ||
 416            mode->vdisplay < 1)
 417                return MODE_V_ILLEGAL;
 418
 419        return MODE_OK;
 420}
 421
 422static void atmel_hlcdc_layer_irq(struct atmel_hlcdc_layer *layer)
 423{
 424        if (!layer)
 425                return;
 426
 427        if (layer->desc->type == ATMEL_HLCDC_BASE_LAYER ||
 428            layer->desc->type == ATMEL_HLCDC_OVERLAY_LAYER ||
 429            layer->desc->type == ATMEL_HLCDC_CURSOR_LAYER)
 430                atmel_hlcdc_plane_irq(atmel_hlcdc_layer_to_plane(layer));
 431}
 432
 433static irqreturn_t atmel_hlcdc_dc_irq_handler(int irq, void *data)
 434{
 435        struct drm_device *dev = data;
 436        struct atmel_hlcdc_dc *dc = dev->dev_private;
 437        unsigned long status;
 438        unsigned int imr, isr;
 439        int i;
 440
 441        regmap_read(dc->hlcdc->regmap, ATMEL_HLCDC_IMR, &imr);
 442        regmap_read(dc->hlcdc->regmap, ATMEL_HLCDC_ISR, &isr);
 443        status = imr & isr;
 444        if (!status)
 445                return IRQ_NONE;
 446
 447        if (status & ATMEL_HLCDC_SOF)
 448                atmel_hlcdc_crtc_irq(dc->crtc);
 449
 450        for (i = 0; i < ATMEL_HLCDC_MAX_LAYERS; i++) {
 451                if (ATMEL_HLCDC_LAYER_STATUS(i) & status)
 452                        atmel_hlcdc_layer_irq(dc->layers[i]);
 453        }
 454
 455        return IRQ_HANDLED;
 456}
 457
 458static struct drm_framebuffer *atmel_hlcdc_fb_create(struct drm_device *dev,
 459                struct drm_file *file_priv, const struct drm_mode_fb_cmd2 *mode_cmd)
 460{
 461        return drm_gem_fb_create(dev, file_priv, mode_cmd);
 462}
 463
 464struct atmel_hlcdc_dc_commit {
 465        struct work_struct work;
 466        struct drm_device *dev;
 467        struct drm_atomic_state *state;
 468};
 469
 470static void
 471atmel_hlcdc_dc_atomic_complete(struct atmel_hlcdc_dc_commit *commit)
 472{
 473        struct drm_device *dev = commit->dev;
 474        struct atmel_hlcdc_dc *dc = dev->dev_private;
 475        struct drm_atomic_state *old_state = commit->state;
 476
 477        /* Apply the atomic update. */
 478        drm_atomic_helper_commit_modeset_disables(dev, old_state);
 479        drm_atomic_helper_commit_planes(dev, old_state, 0);
 480        drm_atomic_helper_commit_modeset_enables(dev, old_state);
 481
 482        drm_atomic_helper_wait_for_vblanks(dev, old_state);
 483
 484        drm_atomic_helper_cleanup_planes(dev, old_state);
 485
 486        drm_atomic_state_put(old_state);
 487
 488        /* Complete the commit, wake up any waiter. */
 489        spin_lock(&dc->commit.wait.lock);
 490        dc->commit.pending = false;
 491        wake_up_all_locked(&dc->commit.wait);
 492        spin_unlock(&dc->commit.wait.lock);
 493
 494        kfree(commit);
 495}
 496
 497static void atmel_hlcdc_dc_atomic_work(struct work_struct *work)
 498{
 499        struct atmel_hlcdc_dc_commit *commit =
 500                container_of(work, struct atmel_hlcdc_dc_commit, work);
 501
 502        atmel_hlcdc_dc_atomic_complete(commit);
 503}
 504
 505static int atmel_hlcdc_dc_atomic_commit(struct drm_device *dev,
 506                                        struct drm_atomic_state *state,
 507                                        bool async)
 508{
 509        struct atmel_hlcdc_dc *dc = dev->dev_private;
 510        struct atmel_hlcdc_dc_commit *commit;
 511        int ret;
 512
 513        ret = drm_atomic_helper_prepare_planes(dev, state);
 514        if (ret)
 515                return ret;
 516
 517        /* Allocate the commit object. */
 518        commit = kzalloc(sizeof(*commit), GFP_KERNEL);
 519        if (!commit) {
 520                ret = -ENOMEM;
 521                goto error;
 522        }
 523
 524        INIT_WORK(&commit->work, atmel_hlcdc_dc_atomic_work);
 525        commit->dev = dev;
 526        commit->state = state;
 527
 528        spin_lock(&dc->commit.wait.lock);
 529        ret = wait_event_interruptible_locked(dc->commit.wait,
 530                                              !dc->commit.pending);
 531        if (ret == 0)
 532                dc->commit.pending = true;
 533        spin_unlock(&dc->commit.wait.lock);
 534
 535        if (ret)
 536                goto err_free;
 537
 538        /* We have our own synchronization through the commit lock. */
 539        BUG_ON(drm_atomic_helper_swap_state(state, false) < 0);
 540
 541        /* Swap state succeeded, this is the point of no return. */
 542        drm_atomic_state_get(state);
 543        if (async)
 544                queue_work(dc->wq, &commit->work);
 545        else
 546                atmel_hlcdc_dc_atomic_complete(commit);
 547
 548        return 0;
 549
 550err_free:
 551        kfree(commit);
 552error:
 553        drm_atomic_helper_cleanup_planes(dev, state);
 554        return ret;
 555}
 556
 557static const struct drm_mode_config_funcs mode_config_funcs = {
 558        .fb_create = atmel_hlcdc_fb_create,
 559        .output_poll_changed = drm_fb_helper_output_poll_changed,
 560        .atomic_check = drm_atomic_helper_check,
 561        .atomic_commit = atmel_hlcdc_dc_atomic_commit,
 562};
 563
 564static int atmel_hlcdc_dc_modeset_init(struct drm_device *dev)
 565{
 566        struct atmel_hlcdc_dc *dc = dev->dev_private;
 567        int ret;
 568
 569        drm_mode_config_init(dev);
 570
 571        ret = atmel_hlcdc_create_outputs(dev);
 572        if (ret) {
 573                dev_err(dev->dev, "failed to create HLCDC outputs: %d\n", ret);
 574                return ret;
 575        }
 576
 577        ret = atmel_hlcdc_create_planes(dev);
 578        if (ret) {
 579                dev_err(dev->dev, "failed to create planes: %d\n", ret);
 580                return ret;
 581        }
 582
 583        ret = atmel_hlcdc_crtc_create(dev);
 584        if (ret) {
 585                dev_err(dev->dev, "failed to create crtc\n");
 586                return ret;
 587        }
 588
 589        dev->mode_config.min_width = dc->desc->min_width;
 590        dev->mode_config.min_height = dc->desc->min_height;
 591        dev->mode_config.max_width = dc->desc->max_width;
 592        dev->mode_config.max_height = dc->desc->max_height;
 593        dev->mode_config.funcs = &mode_config_funcs;
 594
 595        return 0;
 596}
 597
 598static int atmel_hlcdc_dc_load(struct drm_device *dev)
 599{
 600        struct platform_device *pdev = to_platform_device(dev->dev);
 601        const struct of_device_id *match;
 602        struct atmel_hlcdc_dc *dc;
 603        int ret;
 604
 605        match = of_match_node(atmel_hlcdc_of_match, dev->dev->parent->of_node);
 606        if (!match) {
 607                dev_err(&pdev->dev, "invalid compatible string\n");
 608                return -ENODEV;
 609        }
 610
 611        if (!match->data) {
 612                dev_err(&pdev->dev, "invalid hlcdc description\n");
 613                return -EINVAL;
 614        }
 615
 616        dc = devm_kzalloc(dev->dev, sizeof(*dc), GFP_KERNEL);
 617        if (!dc)
 618                return -ENOMEM;
 619
 620        dc->wq = alloc_ordered_workqueue("atmel-hlcdc-dc", 0);
 621        if (!dc->wq)
 622                return -ENOMEM;
 623
 624        init_waitqueue_head(&dc->commit.wait);
 625        dc->desc = match->data;
 626        dc->hlcdc = dev_get_drvdata(dev->dev->parent);
 627        dev->dev_private = dc;
 628
 629        ret = clk_prepare_enable(dc->hlcdc->periph_clk);
 630        if (ret) {
 631                dev_err(dev->dev, "failed to enable periph_clk\n");
 632                goto err_destroy_wq;
 633        }
 634
 635        pm_runtime_enable(dev->dev);
 636
 637        ret = drm_vblank_init(dev, 1);
 638        if (ret < 0) {
 639                dev_err(dev->dev, "failed to initialize vblank\n");
 640                goto err_periph_clk_disable;
 641        }
 642
 643        ret = atmel_hlcdc_dc_modeset_init(dev);
 644        if (ret < 0) {
 645                dev_err(dev->dev, "failed to initialize mode setting\n");
 646                goto err_periph_clk_disable;
 647        }
 648
 649        drm_mode_config_reset(dev);
 650
 651        pm_runtime_get_sync(dev->dev);
 652        ret = drm_irq_install(dev, dc->hlcdc->irq);
 653        pm_runtime_put_sync(dev->dev);
 654        if (ret < 0) {
 655                dev_err(dev->dev, "failed to install IRQ handler\n");
 656                goto err_periph_clk_disable;
 657        }
 658
 659        platform_set_drvdata(pdev, dev);
 660
 661        drm_fb_cma_fbdev_init(dev, 24, 0);
 662
 663        drm_kms_helper_poll_init(dev);
 664
 665        return 0;
 666
 667err_periph_clk_disable:
 668        pm_runtime_disable(dev->dev);
 669        clk_disable_unprepare(dc->hlcdc->periph_clk);
 670
 671err_destroy_wq:
 672        destroy_workqueue(dc->wq);
 673
 674        return ret;
 675}
 676
 677static void atmel_hlcdc_dc_unload(struct drm_device *dev)
 678{
 679        struct atmel_hlcdc_dc *dc = dev->dev_private;
 680
 681        drm_fb_cma_fbdev_fini(dev);
 682        flush_workqueue(dc->wq);
 683        drm_kms_helper_poll_fini(dev);
 684        drm_atomic_helper_shutdown(dev);
 685        drm_mode_config_cleanup(dev);
 686
 687        pm_runtime_get_sync(dev->dev);
 688        drm_irq_uninstall(dev);
 689        pm_runtime_put_sync(dev->dev);
 690
 691        dev->dev_private = NULL;
 692
 693        pm_runtime_disable(dev->dev);
 694        clk_disable_unprepare(dc->hlcdc->periph_clk);
 695        destroy_workqueue(dc->wq);
 696}
 697
 698static int atmel_hlcdc_dc_irq_postinstall(struct drm_device *dev)
 699{
 700        struct atmel_hlcdc_dc *dc = dev->dev_private;
 701        unsigned int cfg = 0;
 702        int i;
 703
 704        /* Enable interrupts on activated layers */
 705        for (i = 0; i < ATMEL_HLCDC_MAX_LAYERS; i++) {
 706                if (dc->layers[i])
 707                        cfg |= ATMEL_HLCDC_LAYER_STATUS(i);
 708        }
 709
 710        regmap_write(dc->hlcdc->regmap, ATMEL_HLCDC_IER, cfg);
 711
 712        return 0;
 713}
 714
 715static void atmel_hlcdc_dc_irq_uninstall(struct drm_device *dev)
 716{
 717        struct atmel_hlcdc_dc *dc = dev->dev_private;
 718        unsigned int isr;
 719
 720        regmap_write(dc->hlcdc->regmap, ATMEL_HLCDC_IDR, 0xffffffff);
 721        regmap_read(dc->hlcdc->regmap, ATMEL_HLCDC_ISR, &isr);
 722}
 723
 724DEFINE_DRM_GEM_CMA_FOPS(fops);
 725
 726static struct drm_driver atmel_hlcdc_dc_driver = {
 727        .driver_features = DRIVER_HAVE_IRQ | DRIVER_GEM |
 728                           DRIVER_MODESET | DRIVER_PRIME |
 729                           DRIVER_ATOMIC,
 730        .lastclose = drm_fb_helper_lastclose,
 731        .irq_handler = atmel_hlcdc_dc_irq_handler,
 732        .irq_preinstall = atmel_hlcdc_dc_irq_uninstall,
 733        .irq_postinstall = atmel_hlcdc_dc_irq_postinstall,
 734        .irq_uninstall = atmel_hlcdc_dc_irq_uninstall,
 735        .gem_free_object_unlocked = drm_gem_cma_free_object,
 736        .gem_vm_ops = &drm_gem_cma_vm_ops,
 737        .prime_handle_to_fd = drm_gem_prime_handle_to_fd,
 738        .prime_fd_to_handle = drm_gem_prime_fd_to_handle,
 739        .gem_prime_import = drm_gem_prime_import,
 740        .gem_prime_export = drm_gem_prime_export,
 741        .gem_prime_get_sg_table = drm_gem_cma_prime_get_sg_table,
 742        .gem_prime_import_sg_table = drm_gem_cma_prime_import_sg_table,
 743        .gem_prime_vmap = drm_gem_cma_prime_vmap,
 744        .gem_prime_vunmap = drm_gem_cma_prime_vunmap,
 745        .gem_prime_mmap = drm_gem_cma_prime_mmap,
 746        .dumb_create = drm_gem_cma_dumb_create,
 747        .fops = &fops,
 748        .name = "atmel-hlcdc",
 749        .desc = "Atmel HLCD Controller DRM",
 750        .date = "20141504",
 751        .major = 1,
 752        .minor = 0,
 753};
 754
 755static int atmel_hlcdc_dc_drm_probe(struct platform_device *pdev)
 756{
 757        struct drm_device *ddev;
 758        int ret;
 759
 760        ddev = drm_dev_alloc(&atmel_hlcdc_dc_driver, &pdev->dev);
 761        if (IS_ERR(ddev))
 762                return PTR_ERR(ddev);
 763
 764        ret = atmel_hlcdc_dc_load(ddev);
 765        if (ret)
 766                goto err_unref;
 767
 768        ret = drm_dev_register(ddev, 0);
 769        if (ret)
 770                goto err_unload;
 771
 772        return 0;
 773
 774err_unload:
 775        atmel_hlcdc_dc_unload(ddev);
 776
 777err_unref:
 778        drm_dev_unref(ddev);
 779
 780        return ret;
 781}
 782
 783static int atmel_hlcdc_dc_drm_remove(struct platform_device *pdev)
 784{
 785        struct drm_device *ddev = platform_get_drvdata(pdev);
 786
 787        drm_dev_unregister(ddev);
 788        atmel_hlcdc_dc_unload(ddev);
 789        drm_dev_unref(ddev);
 790
 791        return 0;
 792}
 793
 794#ifdef CONFIG_PM_SLEEP
 795static int atmel_hlcdc_dc_drm_suspend(struct device *dev)
 796{
 797        struct drm_device *drm_dev = dev_get_drvdata(dev);
 798        struct atmel_hlcdc_dc *dc = drm_dev->dev_private;
 799        struct regmap *regmap = dc->hlcdc->regmap;
 800        struct drm_atomic_state *state;
 801
 802        state = drm_atomic_helper_suspend(drm_dev);
 803        if (IS_ERR(state))
 804                return PTR_ERR(state);
 805
 806        dc->suspend.state = state;
 807
 808        regmap_read(regmap, ATMEL_HLCDC_IMR, &dc->suspend.imr);
 809        regmap_write(regmap, ATMEL_HLCDC_IDR, dc->suspend.imr);
 810        clk_disable_unprepare(dc->hlcdc->periph_clk);
 811
 812        return 0;
 813}
 814
 815static int atmel_hlcdc_dc_drm_resume(struct device *dev)
 816{
 817        struct drm_device *drm_dev = dev_get_drvdata(dev);
 818        struct atmel_hlcdc_dc *dc = drm_dev->dev_private;
 819
 820        clk_prepare_enable(dc->hlcdc->periph_clk);
 821        regmap_write(dc->hlcdc->regmap, ATMEL_HLCDC_IER, dc->suspend.imr);
 822
 823        return drm_atomic_helper_resume(drm_dev, dc->suspend.state);
 824}
 825#endif
 826
 827static SIMPLE_DEV_PM_OPS(atmel_hlcdc_dc_drm_pm_ops,
 828                atmel_hlcdc_dc_drm_suspend, atmel_hlcdc_dc_drm_resume);
 829
 830static const struct of_device_id atmel_hlcdc_dc_of_match[] = {
 831        { .compatible = "atmel,hlcdc-display-controller" },
 832        { },
 833};
 834
 835static struct platform_driver atmel_hlcdc_dc_platform_driver = {
 836        .probe  = atmel_hlcdc_dc_drm_probe,
 837        .remove = atmel_hlcdc_dc_drm_remove,
 838        .driver = {
 839                .name   = "atmel-hlcdc-display-controller",
 840                .pm     = &atmel_hlcdc_dc_drm_pm_ops,
 841                .of_match_table = atmel_hlcdc_dc_of_match,
 842        },
 843};
 844module_platform_driver(atmel_hlcdc_dc_platform_driver);
 845
 846MODULE_AUTHOR("Jean-Jacques Hiblot <jjhiblot@traphandler.com>");
 847MODULE_AUTHOR("Boris Brezillon <boris.brezillon@free-electrons.com>");
 848MODULE_DESCRIPTION("Atmel HLCDC Display Controller DRM Driver");
 849MODULE_LICENSE("GPL");
 850MODULE_ALIAS("platform:atmel-hlcdc-dc");
 851