drivers/gpu/drm/sun4i/sun8i_ui_scaler.c

   1 /*
   2  * Copyright (C) 2017 Jernej Skrabec <jernej.skrabec@siol.net>
   3  *
   4  * Coefficients are taken from BSP driver, which is:
   5  * Copyright (C) 2014-2015 Allwinner
   6  *
   7  * This file is licensed under the terms of the GNU General Public
   8  * License version 2.  This program is licensed "as is" without any
   9  * warranty of any kind, whether express or implied.
  10  */
  11
  12 #include "sun8i_ui_scaler.h"
  13 #include "sun8i_vi_scaler.h"
  14
  15 static const u32 lan2coefftab16[240] = {
  16         0x00004000, 0x00033ffe, 0x00063efc, 0x000a3bfb,
  17         0xff0f37fb, 0xfe1433fb, 0xfd192ffb, 0xfd1f29fb,
  18         0xfc2424fc, 0xfb291ffd, 0xfb2f19fd, 0xfb3314fe,
  19         0xfb370fff, 0xfb3b0a00, 0xfc3e0600, 0xfe3f0300,
  20
  21         0xff053804, 0xff083801, 0xff0a3700, 0xff0e34ff,
  22         0xff1232fd, 0xfe162ffd, 0xfd1b2cfc, 0xfd1f28fc,
  23         0xfd2323fd, 0xfc281ffd, 0xfc2c1bfd, 0xfd2f16fe,
  24         0xfd3212ff, 0xff340eff, 0x00360a00, 0x02370700,
  25
  26         0xff083207, 0xff0a3205, 0xff0d3103, 0xfe113001,
  27         0xfe142e00, 0xfe182bff, 0xfe1b29fe, 0xfe1f25fe,
  28         0xfe2222fe, 0xfe251ffe, 0xfe291bfe, 0xff2b18fe,
  29         0x002e14fe, 0x013010ff, 0x03310dff, 0x05310a00,
  30
  31         0xff0a2e09, 0xff0c2e07, 0xff0f2d05, 0xff122c03,
  32         0xfe152b02, 0xfe182901, 0xfe1b2700, 0xff1e24ff,
  33         0xff2121ff, 0xff241eff, 0x00261bff, 0x012818ff,
  34         0x022a15ff, 0x032c12ff, 0x052d0fff, 0x072d0c00,
  35
  36         0xff0c2a0b, 0xff0e2a09, 0xff102a07, 0xff132905,
  37         0xff162803, 0xff182702, 0xff1b2501, 0xff1e2300,
  38         0x00202000, 0x01221d00, 0x01251bff, 0x032618ff,
  39         0x042815ff, 0x052913ff, 0x072a10ff, 0x092a0d00,
  40
  41         0xff0d280c, 0xff0f280a, 0xff112808, 0xff142706,
  42         0xff162605, 0xff192503, 0x001b2302, 0x001d2201,
  43         0x011f1f01, 0x01221d00, 0x02231b00, 0x04241800,
  44         0x052616ff, 0x072713ff, 0x08271100, 0x0a280e00,
  45
  46         0xff0e260d, 0xff10260b, 0xff122609, 0xff142508,
  47         0x00152506, 0x00182305, 0x001b2203, 0x011d2002,
  48         0x011f1f01, 0x02201d01, 0x03221b00, 0x04231801,
  49         0x06241600, 0x08251300, 0x09261100, 0x0b260f00,
  50
  51         0xff0e250e, 0xff10250c, 0x0011250a, 0x00142408,
  52         0x00162307, 0x00182206, 0x011a2104, 0x011c2003,
  53         0x021e1e02, 0x03201c01, 0x04211a01, 0x05221801,
  54         0x07231600, 0x08241400, 0x0a241200, 0x0c241000,
  55
  56         0x000e240e, 0x0010240c, 0x0013230a, 0x00142309,
  57         0x00162208, 0x01182106, 0x011a2005, 0x021b1f04,
  58         0x031d1d03, 0x041e1c02, 0x05201a01, 0x06211801,
  59         0x07221601, 0x09231400, 0x0a231300, 0x0c231100,
  60
  61         0x000f220f, 0x0011220d, 0x0013220b, 0x0015210a,
  62         0x01162108, 0x01182007, 0x02191f06, 0x031a1e05,
  63         0x041c1c04, 0x051d1b03, 0x061f1902, 0x07201801,
  64         0x08211601, 0x0a211500, 0x0b221300, 0x0d221100,
  65
  66         0x0010210f, 0x0011210e, 0x0013210c, 0x0114200b,
  67         0x01161f0a, 0x02171f08, 0x03181e07, 0x031a1d06,
  68         0x041c1c04, 0x051d1a04, 0x071d1903, 0x081e1802,
  69         0x091f1602, 0x0b1f1501, 0x0c211300, 0x0e201200,
  70
  71         0x00102010, 0x0012200e, 0x0013200d, 0x01151f0b,
  72         0x01161f0a, 0x02171e09, 0x03191d07, 0x041a1c06,
  73         0x051b1b05, 0x061c1a04, 0x071d1903, 0x081e1703,
  74         0x0a1f1601, 0x0b1f1501, 0x0d201300, 0x0e201200,
  75
  76         0x00102010, 0x00121f0f, 0x00141f0d, 0x01141f0c,
  77         0x02161e0a, 0x03171d09, 0x03181d08, 0x041a1c06,
  78         0x051b1b05, 0x061c1a04, 0x081c1903, 0x091d1703,
  79         0x0a1e1602, 0x0c1e1501, 0x0d1f1400, 0x0e1f1201,
  80
  81         0x00111e11, 0x00131e0f, 0x01131e0e, 0x02151d0c,
  82         0x02161d0b, 0x03171c0a, 0x04181b09, 0x05191b07,
  83         0x061a1a06, 0x071b1905, 0x091b1804, 0x0a1c1703,
  84         0x0b1d1602, 0x0c1d1502, 0x0e1d1401, 0x0f1e1300,
  85
  86         0x00111e11, 0x00131d10, 0x01141d0e, 0x02151c0d,
  87         0x03161c0b, 0x04171b0a, 0x05171b09, 0x06181a08,
  88         0x07191907, 0x081a1806, 0x091a1805, 0x0a1b1704,
  89         0x0b1c1603, 0x0d1c1502, 0x0e1d1401, 0x0f1d1301,
  90 };
  91
  92 static u32 sun8i_ui_scaler_base(struct sun8i_mixer *mixer, int channel)
  93 {
  94         int vi_num = mixer->cfg->vi_num;
  95
  96         if (mixer->cfg->is_de3)
  97                 return DE3_VI_SCALER_UNIT_BASE +
  98                        DE3_VI_SCALER_UNIT_SIZE * vi_num +
  99                        DE3_UI_SCALER_UNIT_SIZE * (channel - vi_num);
 100         else
 101                 return DE2_VI_SCALER_UNIT_BASE +
 102                        DE2_VI_SCALER_UNIT_SIZE * vi_num +
 103                        DE2_UI_SCALER_UNIT_SIZE * (channel - vi_num);
 104 }
 105
 106 static int sun8i_ui_scaler_coef_index(unsigned int step)
 107 {
 108         unsigned int scale, int_part, float_part;
 109
 110         scale = step >> (SUN8I_UI_SCALER_SCALE_FRAC - 3);
 111         int_part = scale >> 3;
 112         float_part = scale & 0x7;
 113
 114         switch (int_part) {
 115         case 0:
 116                 return 0;
 117         case 1:
 118                 return float_part;
 119         case 2:
 120                 return 8 + (float_part >> 1);
 121         case 3:
 122                 return 12;
 123         case 4:
 124                 return 13;
 125         default:
 126                 return 14;
 127         }
 128 }
 129
 130 void sun8i_ui_scaler_enable(struct sun8i_mixer *mixer, int layer, bool enable)
 131 {
 132         u32 val, base;
 133
 134         if (WARN_ON(layer < mixer->cfg->vi_num))
 135                 return;
 136
 137         base = sun8i_ui_scaler_base(mixer, layer);
 138
 139         if (enable)
 140                 val = SUN8I_SCALER_GSU_CTRL_EN |
 141                       SUN8I_SCALER_GSU_CTRL_COEFF_RDY;
 142         else
 143                 val = 0;
 144
 145         regmap_write(mixer->engine.regs, SUN8I_SCALER_GSU_CTRL(base), val);
 146 }
 147
 148 void sun8i_ui_scaler_setup(struct sun8i_mixer *mixer, int layer,
 149                            u32 src_w, u32 src_h, u32 dst_w, u32 dst_h,
 150                            u32 hscale, u32 vscale, u32 hphase, u32 vphase)
 151 {
 152         u32 insize, outsize;
 153         int i, offset;
 154         u32 base;
 155
 156         if (WARN_ON(layer < mixer->cfg->vi_num))
 157                 return;
 158
 159         base = sun8i_ui_scaler_base(mixer, layer);
 160
 161         hphase <<= SUN8I_UI_SCALER_PHASE_FRAC - 16;
 162         vphase <<= SUN8I_UI_SCALER_PHASE_FRAC - 16;
 163         hscale <<= SUN8I_UI_SCALER_SCALE_FRAC - 16;
 164         vscale <<= SUN8I_UI_SCALER_SCALE_FRAC - 16;
 165
 166         insize = SUN8I_UI_SCALER_SIZE(src_w, src_h);
 167         outsize = SUN8I_UI_SCALER_SIZE(dst_w, dst_h);
 168
 169         regmap_write(mixer->engine.regs,
 170                      SUN8I_SCALER_GSU_OUTSIZE(base), outsize);
 171         regmap_write(mixer->engine.regs,
 172                      SUN8I_SCALER_GSU_INSIZE(base), insize);
 173         regmap_write(mixer->engine.regs,
 174                      SUN8I_SCALER_GSU_HSTEP(base), hscale);
 175         regmap_write(mixer->engine.regs,
 176                      SUN8I_SCALER_GSU_VSTEP(base), vscale);
 177         regmap_write(mixer->engine.regs,
 178                      SUN8I_SCALER_GSU_HPHASE(base), hphase);
 179         regmap_write(mixer->engine.regs,
 180                      SUN8I_SCALER_GSU_VPHASE(base), vphase);
 181         offset = sun8i_ui_scaler_coef_index(hscale) *
 182                         SUN8I_UI_SCALER_COEFF_COUNT;
 183         for (i = 0; i < SUN8I_UI_SCALER_COEFF_COUNT; i++)
 184                 regmap_write(mixer->engine.regs,
 185                              SUN8I_SCALER_GSU_HCOEFF(base, i),
 186                              lan2coefftab16[offset + i]);
 187 }