drm/bridge: tc358767: Simplify tc_set_video_mode()
[sfrench/cifs-2.6.git] / drivers / gpu / drm / bridge / tc358767.c
index 0270d18deb5eb9eb302f5023a254ec5c0b52f77e..b3a4814f2a6254e1b8309d9534ef2b4f73757d8a 100644 (file)
@@ -15,6 +15,7 @@
  * Author: Rob Clark <robdclark@gmail.com>
  */
 
+#include <linux/bitfield.h>
 #include <linux/clk.h>
 #include <linux/device.h>
 #include <linux/gpio/consumer.h>
@@ -47,6 +48,7 @@
 
 /* Video Path */
 #define VPCTRL0                        0x0450
+#define VSDELAY                        GENMASK(31, 20)
 #define OPXLFMT_RGB666                 (0 << 8)
 #define OPXLFMT_RGB888                 (1 << 8)
 #define FRMSYNC_DISABLED               (0 << 4) /* Video Timing Gen Disabled */
 #define MSF_DISABLED                   (0 << 0) /* Magic Square FRC disabled */
 #define MSF_ENABLED                    (1 << 0) /* Magic Square FRC enabled */
 #define HTIM01                 0x0454
+#define HPW                    GENMASK(8, 0)
+#define HBPR                   GENMASK(24, 16)
 #define HTIM02                 0x0458
+#define HDISPR                 GENMASK(10, 0)
+#define HFPR                   GENMASK(24, 16)
 #define VTIM01                 0x045c
+#define VSPR                   GENMASK(7, 0)
+#define VBPR                   GENMASK(23, 16)
 #define VTIM02                 0x0460
+#define VFPR                   GENMASK(23, 16)
+#define VDISPR                 GENMASK(10, 0)
 #define VFUEN0                 0x0464
 #define VFUEN                          BIT(0)   /* Video Frame Timing Upload */
 
 /* Main Channel */
 #define DP0_SECSAMPLE          0x0640
 #define DP0_VIDSYNCDELAY       0x0644
+#define VID_SYNC_DLY           GENMASK(15, 0)
+#define THRESH_DLY             GENMASK(31, 16)
+
 #define DP0_TOTALVAL           0x0648
+#define H_TOTAL                        GENMASK(15, 0)
+#define V_TOTAL                        GENMASK(31, 16)
 #define DP0_STARTVAL           0x064c
+#define H_START                        GENMASK(15, 0)
+#define V_START                        GENMASK(31, 16)
 #define DP0_ACTIVEVAL          0x0650
+#define H_ACT                  GENMASK(15, 0)
+#define V_ACT                  GENMASK(31, 16)
+
 #define DP0_SYNCVAL            0x0654
+#define VS_WIDTH               GENMASK(30, 16)
+#define HS_WIDTH               GENMASK(14, 0)
 #define SYNCVAL_HS_POL_ACTIVE_LOW      (1 << 15)
 #define SYNCVAL_VS_POL_ACTIVE_LOW      (1 << 31)
 #define DP0_MISC               0x0658
 #define TU_SIZE_RECOMMENDED            (63) /* LSCLK cycles per TU */
+#define MAX_TU_SYMBOL          GENMASK(28, 23)
+#define TU_SIZE                        GENMASK(21, 16)
 #define BPC_6                          (0 << 5)
 #define BPC_8                          (1 << 5)
 
 
 /* Test & Debug */
 #define TSTCTL                 0x0a00
+#define COLOR_R                        GENMASK(31, 24)
+#define COLOR_G                        GENMASK(23, 16)
+#define COLOR_B                        GENMASK(15, 8)
+#define ENI2CFILTER            BIT(4)
+#define COLOR_BAR_MODE         GENMASK(1, 0)
+#define COLOR_BAR_MODE_BARS    2
 #define PLL_DBG                        0x0a04
 
 static bool tc_test_pattern;
@@ -663,6 +693,7 @@ static int tc_set_video_mode(struct tc_data *tc,
        int upper_margin = mode->vtotal - mode->vsync_end;
        int lower_margin = mode->vsync_start - mode->vdisplay;
        int vsync_len = mode->vsync_end - mode->vsync_start;
+       u32 dp0_syncval;
 
        /*
         * Recommended maximum number of symbols transferred in a transfer unit:
@@ -687,50 +718,69 @@ static int tc_set_video_mode(struct tc_data *tc,
         * assume we do not need any delay when DPI is a source of
         * sync signals
         */
-       tc_write(VPCTRL0, (0 << 20) /* VSDELAY */ |
+       tc_write(VPCTRL0,
+                FIELD_PREP(VSDELAY, 0) |
                 OPXLFMT_RGB888 | FRMSYNC_DISABLED | MSF_DISABLED);
-       tc_write(HTIM01, (ALIGN(left_margin, 2) << 16) | /* H back porch */
-                        (ALIGN(hsync_len, 2) << 0));    /* Hsync */
-       tc_write(HTIM02, (ALIGN(right_margin, 2) << 16) |  /* H front porch */
-                        (ALIGN(mode->hdisplay, 2) << 0)); /* width */
-       tc_write(VTIM01, (upper_margin << 16) |         /* V back porch */
-                        (vsync_len << 0));             /* Vsync */
-       tc_write(VTIM02, (lower_margin << 16) |         /* V front porch */
-                        (mode->vdisplay << 0));        /* height */
+       tc_write(HTIM01,
+                FIELD_PREP(HBPR, ALIGN(left_margin, 2)) |
+                FIELD_PREP(HPW, ALIGN(hsync_len, 2)));
+       tc_write(HTIM02,
+                FIELD_PREP(HDISPR, ALIGN(mode->hdisplay, 2)) |
+                FIELD_PREP(HFPR, ALIGN(right_margin, 2)));
+       tc_write(VTIM01,
+                FIELD_PREP(VBPR, upper_margin) |
+                FIELD_PREP(VSPR, vsync_len));
+       tc_write(VTIM02,
+                FIELD_PREP(VFPR, lower_margin) |
+                FIELD_PREP(VDISPR, mode->vdisplay));
        tc_write(VFUEN0, VFUEN);                /* update settings */
 
        /* Test pattern settings */
        tc_write(TSTCTL,
-                (120 << 24) |  /* Red Color component value */
-                (20 << 16) |   /* Green Color component value */
-                (99 << 8) |    /* Blue Color component value */
-                (1 << 4) |     /* Enable I2C Filter */
-                (2 << 0) |     /* Color bar Mode */
-                0);
+                FIELD_PREP(COLOR_R, 120) |
+                FIELD_PREP(COLOR_G, 20) |
+                FIELD_PREP(COLOR_B, 99) |
+                ENI2CFILTER |
+                FIELD_PREP(COLOR_BAR_MODE, COLOR_BAR_MODE_BARS));
 
        /* DP Main Stream Attributes */
        vid_sync_dly = hsync_len + left_margin + mode->hdisplay;
        tc_write(DP0_VIDSYNCDELAY,
-                (max_tu_symbol << 16) |        /* thresh_dly */
-                (vid_sync_dly << 0));
+                FIELD_PREP(THRESH_DLY, max_tu_symbol) |
+                FIELD_PREP(VID_SYNC_DLY, vid_sync_dly));
 
-       tc_write(DP0_TOTALVAL, (mode->vtotal << 16) | (mode->htotal));
+       tc_write(DP0_TOTALVAL,
+                FIELD_PREP(H_TOTAL, mode->htotal) |
+                FIELD_PREP(V_TOTAL, mode->vtotal));
 
        tc_write(DP0_STARTVAL,
-                ((upper_margin + vsync_len) << 16) |
-                ((left_margin + hsync_len) << 0));
+                FIELD_PREP(H_START, left_margin + hsync_len) |
+                FIELD_PREP(V_START, upper_margin + vsync_len));
+
+       tc_write(DP0_ACTIVEVAL,
+                FIELD_PREP(V_ACT, mode->vdisplay) |
+                FIELD_PREP(H_ACT, mode->hdisplay));
+
+       dp0_syncval = FIELD_PREP(VS_WIDTH, vsync_len) |
+                     FIELD_PREP(HS_WIDTH, hsync_len);
+
+       if (mode->flags & DRM_MODE_FLAG_NVSYNC)
+               dp0_syncval |= SYNCVAL_VS_POL_ACTIVE_LOW;
 
-       tc_write(DP0_ACTIVEVAL, (mode->vdisplay << 16) | (mode->hdisplay));
+       if (mode->flags & DRM_MODE_FLAG_NHSYNC)
+               dp0_syncval |= SYNCVAL_HS_POL_ACTIVE_LOW;
 
-       tc_write(DP0_SYNCVAL, (vsync_len << 16) | (hsync_len << 0) |
-                ((mode->flags & DRM_MODE_FLAG_NHSYNC) ? SYNCVAL_HS_POL_ACTIVE_LOW : 0) |
-                ((mode->flags & DRM_MODE_FLAG_NVSYNC) ? SYNCVAL_VS_POL_ACTIVE_LOW : 0));
+       tc_write(DP0_SYNCVAL, dp0_syncval);
 
-       tc_write(DPIPXLFMT, VS_POL_ACTIVE_LOW | HS_POL_ACTIVE_LOW |
-                DE_POL_ACTIVE_HIGH | SUB_CFG_TYPE_CONFIG1 | DPI_BPP_RGB888);
+       tc_write(DPIPXLFMT,
+                VS_POL_ACTIVE_LOW | HS_POL_ACTIVE_LOW |
+                DE_POL_ACTIVE_HIGH | SUB_CFG_TYPE_CONFIG1 |
+                DPI_BPP_RGB888);
 
-       tc_write(DP0_MISC, (max_tu_symbol << 23) | (TU_SIZE_RECOMMENDED << 16) |
-                          BPC_8);
+       tc_write(DP0_MISC,
+                FIELD_PREP(MAX_TU_SYMBOL, max_tu_symbol) |
+                FIELD_PREP(TU_SIZE, TU_SIZE_RECOMMENDED) |
+                BPC_8);
 
        return 0;
 err: