Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 1 | /* Copyright (c) 2017, The Linux Foundation. All rights reserved. |
| 2 | * |
| 3 | * This program is free software; you can redistribute it and/or modify |
| 4 | * it under the terms of the GNU General Public License version 2 and |
| 5 | * only version 2 as published by the Free Software Foundation. |
| 6 | * |
| 7 | * This program is distributed in the hope that it will be useful, |
| 8 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 9 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 10 | * GNU General Public License for more details. |
| 11 | */ |
| 12 | |
| 13 | #define pr_fmt(fmt) "[drm:%s:%d] " fmt, __func__, __LINE__ |
| 14 | |
| 15 | #include <linux/mutex.h> |
| 16 | #include <linux/platform_device.h> |
| 17 | |
| 18 | #include "sde_kms.h" |
| 19 | #include "sde_hw_mdss.h" |
| 20 | #include "sde_hwio.h" |
| 21 | #include "sde_hw_catalog.h" |
| 22 | #include "sde_hw_rot.h" |
| 23 | #include "sde_formats.h" |
| 24 | #include "sde_rotator_inline.h" |
| 25 | |
| 26 | #define SDE_MODIFLER(_modifier_) ((_modifier_) & 0x00ffffffffffffffULL) |
| 27 | #define SDE_MODIFIER_IS_TILE(_modifier_) \ |
| 28 | SDE_MODIFLER((_modifier_) & DRM_FORMAT_MOD_QCOM_TILE) |
| 29 | #define SDE_MODIFIER_IS_UBWC(_modifier_) \ |
| 30 | SDE_MODIFLER((_modifier_) & DRM_FORMAT_MOD_QCOM_COMPRESSED) |
| 31 | #define SDE_MODIFIER_IS_10B(_modifier_) \ |
| 32 | SDE_MODIFLER((_modifier_) & DRM_FORMAT_MOD_QCOM_DX) |
| 33 | #define SDE_MODIFIER_IS_TIGHT(_modifier_) \ |
| 34 | SDE_MODIFLER((_modifier_) & DRM_FORMAT_MOD_QCOM_TIGHT) |
| 35 | |
| 36 | /** |
| 37 | * _rot_offset - update register map of the given rotator instance |
| 38 | * @rot: rotator identifier |
| 39 | * @m: Pointer to mdss catalog |
| 40 | * @addr: i/o address mapping |
| 41 | * @b: Pointer to register block mapping structure |
| 42 | * return: Pointer to rotator configuration of the given instance |
| 43 | */ |
| 44 | static struct sde_rot_cfg *_rot_offset(enum sde_rot rot, |
| 45 | struct sde_mdss_cfg *m, |
| 46 | void __iomem *addr, |
| 47 | struct sde_hw_blk_reg_map *b) |
| 48 | { |
| 49 | int i; |
| 50 | |
| 51 | for (i = 0; i < m->rot_count; i++) { |
| 52 | if (rot == m->rot[i].id) { |
| 53 | b->base_off = addr; |
| 54 | b->blk_off = m->rot[i].base; |
| 55 | b->hwversion = m->hwversion; |
| 56 | b->log_mask = SDE_DBG_MASK_ROT; |
| 57 | return &m->rot[i]; |
| 58 | } |
| 59 | } |
| 60 | |
| 61 | return ERR_PTR(-EINVAL); |
| 62 | } |
| 63 | |
| 64 | /** |
| 65 | * sde_hw_rot_start - start rotator before any commit |
| 66 | * @hw: Pointer to rotator hardware driver |
| 67 | * return: 0 if success; error code otherwise |
| 68 | */ |
| 69 | static int sde_hw_rot_start(struct sde_hw_rot *hw) |
| 70 | { |
| 71 | struct platform_device *pdev; |
| 72 | int rc; |
| 73 | |
| 74 | if (!hw || !hw->caps || !hw->caps->pdev) { |
| 75 | SDE_ERROR("invalid parameters\n"); |
| 76 | return -EINVAL; |
| 77 | } |
| 78 | |
| 79 | pdev = hw->caps->pdev; |
| 80 | |
| 81 | hw->rot_ctx = sde_rotator_inline_open(pdev); |
| 82 | if (IS_ERR_OR_NULL(hw->rot_ctx)) { |
| 83 | rc = PTR_ERR(hw->rot_ctx); |
| 84 | hw->rot_ctx = NULL; |
| 85 | return rc; |
| 86 | } |
| 87 | |
| 88 | return 0; |
| 89 | } |
| 90 | |
| 91 | /** |
| 92 | * sde_hw_rot_stop - stop rotator after final commit |
| 93 | * @hw: Pointer to rotator hardware driver |
| 94 | * return: none |
| 95 | */ |
| 96 | static void sde_hw_rot_stop(struct sde_hw_rot *hw) |
| 97 | { |
| 98 | if (!hw) { |
| 99 | SDE_ERROR("invalid parameter\n"); |
| 100 | return; |
| 101 | } |
| 102 | |
| 103 | sde_rotator_inline_release(hw->rot_ctx); |
| 104 | hw->rot_ctx = NULL; |
| 105 | } |
| 106 | |
| 107 | /** |
| 108 | * sde_hw_rot_to_v4l2_pixfmt - convert drm pixel format to v4l2 pixel format |
| 109 | * @drm_pixfmt: drm fourcc pixel format |
| 110 | * @drm_modifier: drm pixel format modifier |
| 111 | * @pixfmt: Pointer to v4l2 fourcc pixel format (output) |
| 112 | * return: 0 if success; error code otherwise |
| 113 | */ |
| 114 | static int sde_hw_rot_to_v4l2_pixfmt(u32 drm_pixfmt, u64 drm_modifier, |
| 115 | u32 *pixfmt) |
| 116 | { |
| 117 | u32 rc = 0; |
| 118 | |
| 119 | if (!pixfmt) |
| 120 | return -EINVAL; |
| 121 | |
| 122 | switch (drm_pixfmt) { |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 123 | case DRM_FORMAT_BGR565: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 124 | if (SDE_MODIFIER_IS_UBWC(drm_modifier)) |
| 125 | *pixfmt = SDE_PIX_FMT_RGB_565_UBWC; |
| 126 | else |
| 127 | *pixfmt = SDE_PIX_FMT_RGB_565; |
| 128 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 129 | case DRM_FORMAT_BGRA8888: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 130 | if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 131 | *pixfmt = SDE_PIX_FMT_ARGB_8888_TILE; |
| 132 | else |
| 133 | *pixfmt = SDE_PIX_FMT_ARGB_8888; |
| 134 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 135 | case DRM_FORMAT_BGRX8888: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 136 | if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 137 | *pixfmt = SDE_PIX_FMT_XRGB_8888_TILE; |
| 138 | else |
| 139 | *pixfmt = SDE_PIX_FMT_XRGB_8888; |
| 140 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 141 | case DRM_FORMAT_RGBA8888: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 142 | if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 143 | *pixfmt = SDE_PIX_FMT_ABGR_8888_TILE; |
| 144 | else |
| 145 | *pixfmt = SDE_PIX_FMT_ABGR_8888; |
| 146 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 147 | case DRM_FORMAT_RGBX8888: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 148 | if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 149 | *pixfmt = SDE_PIX_FMT_XBGR_8888_TILE; |
| 150 | else |
| 151 | *pixfmt = SDE_PIX_FMT_XBGR_8888; |
| 152 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 153 | case DRM_FORMAT_ABGR8888: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 154 | if (SDE_MODIFIER_IS_UBWC(drm_modifier)) |
| 155 | *pixfmt = SDE_PIX_FMT_RGBA_8888_UBWC; |
| 156 | else if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 157 | *pixfmt = SDE_PIX_FMT_RGBA_8888_TILE; |
| 158 | else |
| 159 | *pixfmt = SDE_PIX_FMT_RGBA_8888; |
| 160 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 161 | case DRM_FORMAT_XBGR8888: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 162 | if (SDE_MODIFIER_IS_UBWC(drm_modifier)) |
| 163 | *pixfmt = SDE_PIX_FMT_RGBX_8888_UBWC; |
| 164 | else if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 165 | *pixfmt = SDE_PIX_FMT_RGBX_8888_TILE; |
| 166 | else |
| 167 | *pixfmt = SDE_PIX_FMT_RGBX_8888; |
| 168 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 169 | case DRM_FORMAT_ARGB8888: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 170 | if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 171 | *pixfmt = SDE_PIX_FMT_BGRA_8888_TILE; |
| 172 | else |
| 173 | *pixfmt = SDE_PIX_FMT_BGRA_8888; |
| 174 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 175 | case DRM_FORMAT_XRGB8888: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 176 | if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 177 | *pixfmt = SDE_PIX_FMT_BGRX_8888_TILE; |
| 178 | else |
| 179 | *pixfmt = SDE_PIX_FMT_BGRX_8888; |
| 180 | break; |
| 181 | case DRM_FORMAT_NV12: |
| 182 | if (SDE_MODIFIER_IS_UBWC(drm_modifier)) { |
Alan Kwong | 87847ce | 2017-02-21 08:34:31 -0800 | [diff] [blame] | 183 | if (SDE_MODIFIER_IS_10B(drm_modifier)) { |
| 184 | if (SDE_MODIFIER_IS_TIGHT(drm_modifier)) |
| 185 | *pixfmt = |
| 186 | SDE_PIX_FMT_Y_CBCR_H2V2_TP10_UBWC; |
| 187 | else |
| 188 | *pixfmt = |
| 189 | SDE_PIX_FMT_Y_CBCR_H2V2_P010_UBWC; |
| 190 | } else { |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 191 | *pixfmt = SDE_PIX_FMT_Y_CBCR_H2V2_UBWC; |
Alan Kwong | 87847ce | 2017-02-21 08:34:31 -0800 | [diff] [blame] | 192 | } |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 193 | } else if (SDE_MODIFIER_IS_TILE(drm_modifier)) { |
| 194 | if (SDE_MODIFIER_IS_10B(drm_modifier)) { |
| 195 | if (SDE_MODIFIER_IS_TIGHT(drm_modifier)) |
| 196 | *pixfmt = |
| 197 | SDE_PIX_FMT_Y_CBCR_H2V2_TP10; |
| 198 | else |
| 199 | *pixfmt = |
| 200 | SDE_PIX_FMT_Y_CBCR_H2V2_P010_TILE; |
| 201 | } else { |
| 202 | *pixfmt = SDE_PIX_FMT_Y_CBCR_H2V2_TILE; |
| 203 | } |
| 204 | } else { |
| 205 | if (SDE_MODIFIER_IS_10B(drm_modifier)) { |
| 206 | if (SDE_MODIFIER_IS_TIGHT(drm_modifier)) |
| 207 | *pixfmt = |
| 208 | SDE_PIX_FMT_Y_CBCR_H2V2_TP10; |
| 209 | else |
| 210 | *pixfmt = |
| 211 | SDE_PIX_FMT_Y_CBCR_H2V2_P010; |
| 212 | } else { |
| 213 | *pixfmt = SDE_PIX_FMT_Y_CBCR_H2V2; |
| 214 | } |
| 215 | } |
| 216 | break; |
| 217 | case DRM_FORMAT_NV21: |
| 218 | if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 219 | *pixfmt = SDE_PIX_FMT_Y_CRCB_H2V2_TILE; |
| 220 | else |
| 221 | *pixfmt = SDE_PIX_FMT_Y_CRCB_H2V2; |
| 222 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 223 | case DRM_FORMAT_BGRA1010102: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 224 | if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 225 | *pixfmt = SDE_PIX_FMT_ARGB_2101010_TILE; |
| 226 | else |
| 227 | *pixfmt = SDE_PIX_FMT_ARGB_2101010; |
| 228 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 229 | case DRM_FORMAT_BGRX1010102: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 230 | if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 231 | *pixfmt = SDE_PIX_FMT_XRGB_2101010_TILE; |
| 232 | else |
| 233 | *pixfmt = SDE_PIX_FMT_XRGB_2101010; |
| 234 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 235 | case DRM_FORMAT_RGBA1010102: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 236 | if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 237 | *pixfmt = SDE_PIX_FMT_ABGR_2101010_TILE; |
| 238 | else |
| 239 | *pixfmt = SDE_PIX_FMT_ABGR_2101010; |
| 240 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 241 | case DRM_FORMAT_RGBX1010102: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 242 | if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 243 | *pixfmt = SDE_PIX_FMT_XBGR_2101010_TILE; |
| 244 | else |
| 245 | *pixfmt = SDE_PIX_FMT_XBGR_2101010; |
| 246 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 247 | case DRM_FORMAT_ARGB2101010: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 248 | if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 249 | *pixfmt = SDE_PIX_FMT_BGRA_1010102_TILE; |
| 250 | else |
| 251 | *pixfmt = SDE_PIX_FMT_BGRA_1010102; |
| 252 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 253 | case DRM_FORMAT_XRGB2101010: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 254 | if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 255 | *pixfmt = SDE_PIX_FMT_BGRX_1010102_TILE; |
| 256 | else |
| 257 | *pixfmt = SDE_PIX_FMT_BGRX_1010102; |
| 258 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 259 | case DRM_FORMAT_ABGR2101010: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 260 | if (SDE_MODIFIER_IS_UBWC(drm_modifier)) |
| 261 | *pixfmt = SDE_PIX_FMT_RGBA_1010102_UBWC; |
| 262 | else if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 263 | *pixfmt = SDE_PIX_FMT_RGBA_1010102_TILE; |
| 264 | else |
| 265 | *pixfmt = SDE_PIX_FMT_RGBA_1010102; |
| 266 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 267 | case DRM_FORMAT_XBGR2101010: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 268 | if (SDE_MODIFIER_IS_UBWC(drm_modifier)) |
| 269 | *pixfmt = SDE_PIX_FMT_RGBX_1010102_UBWC; |
| 270 | else if (SDE_MODIFIER_IS_TILE(drm_modifier)) |
| 271 | *pixfmt = SDE_PIX_FMT_RGBX_1010102_TILE; |
| 272 | else |
| 273 | *pixfmt = SDE_PIX_FMT_RGBX_1010102; |
| 274 | break; |
| 275 | default: |
| 276 | SDE_ERROR("invalid drm pixel format %c%c%c%c/%llx\n", |
| 277 | drm_pixfmt >> 0, drm_pixfmt >> 8, |
| 278 | drm_pixfmt >> 16, drm_pixfmt >> 24, |
| 279 | drm_modifier); |
| 280 | rc = -EINVAL; |
| 281 | break; |
| 282 | } |
| 283 | |
| 284 | return rc; |
| 285 | } |
| 286 | |
| 287 | /** |
| 288 | * sde_hw_rot_to_drm_pixfmt - convert v4l2 pixel format to drm pixel format |
| 289 | * @pixfmt: v4l2 fourcc pixel format |
| 290 | * @drm_pixfmt: Pointer to drm forucc pixel format (output) |
| 291 | * @drm_modifier: Pointer to drm pixel format modifier (output) |
| 292 | * return: 0 if success; error code otherwise |
| 293 | */ |
| 294 | static int sde_hw_rot_to_drm_pixfmt(u32 pixfmt, u32 *drm_pixfmt, |
| 295 | u64 *drm_modifier) |
| 296 | { |
| 297 | u32 rc = 0; |
| 298 | |
| 299 | switch (pixfmt) { |
| 300 | case SDE_PIX_FMT_RGB_565: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 301 | *drm_pixfmt = DRM_FORMAT_BGR565; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 302 | *drm_modifier = 0; |
| 303 | break; |
| 304 | case SDE_PIX_FMT_RGB_565_UBWC: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 305 | *drm_pixfmt = DRM_FORMAT_BGR565; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 306 | *drm_modifier = DRM_FORMAT_MOD_QCOM_COMPRESSED | |
| 307 | DRM_FORMAT_MOD_QCOM_TILE; |
| 308 | break; |
| 309 | case SDE_PIX_FMT_RGBA_8888: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 310 | *drm_pixfmt = DRM_FORMAT_ABGR8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 311 | *drm_modifier = 0; |
| 312 | break; |
| 313 | case SDE_PIX_FMT_RGBX_8888: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 314 | *drm_pixfmt = DRM_FORMAT_XBGR8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 315 | *drm_modifier = 0; |
| 316 | break; |
| 317 | case SDE_PIX_FMT_BGRA_8888: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 318 | *drm_pixfmt = DRM_FORMAT_ARGB8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 319 | *drm_modifier = 0; |
| 320 | break; |
| 321 | case SDE_PIX_FMT_BGRX_8888: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 322 | *drm_pixfmt = DRM_FORMAT_XRGB8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 323 | *drm_modifier = 0; |
| 324 | break; |
| 325 | case SDE_PIX_FMT_Y_CBCR_H2V2_UBWC: |
| 326 | *drm_pixfmt = DRM_FORMAT_NV12; |
| 327 | *drm_modifier = DRM_FORMAT_MOD_QCOM_COMPRESSED | |
| 328 | DRM_FORMAT_MOD_QCOM_TILE; |
| 329 | break; |
| 330 | case SDE_PIX_FMT_Y_CRCB_H2V2: |
| 331 | *drm_pixfmt = DRM_FORMAT_NV21; |
| 332 | *drm_modifier = 0; |
| 333 | break; |
| 334 | case SDE_PIX_FMT_RGBA_8888_UBWC: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 335 | *drm_pixfmt = DRM_FORMAT_ABGR8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 336 | *drm_modifier = DRM_FORMAT_MOD_QCOM_COMPRESSED | |
| 337 | DRM_FORMAT_MOD_QCOM_TILE; |
| 338 | break; |
| 339 | case SDE_PIX_FMT_RGBX_8888_UBWC: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 340 | *drm_pixfmt = DRM_FORMAT_XBGR8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 341 | *drm_modifier = DRM_FORMAT_MOD_QCOM_COMPRESSED | |
| 342 | DRM_FORMAT_MOD_QCOM_TILE; |
| 343 | break; |
| 344 | case SDE_PIX_FMT_Y_CBCR_H2V2: |
| 345 | *drm_pixfmt = DRM_FORMAT_NV12; |
| 346 | *drm_modifier = 0; |
| 347 | break; |
| 348 | case SDE_PIX_FMT_ARGB_8888: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 349 | *drm_pixfmt = DRM_FORMAT_BGRA8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 350 | *drm_modifier = 0; |
| 351 | break; |
| 352 | case SDE_PIX_FMT_XRGB_8888: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 353 | *drm_pixfmt = DRM_FORMAT_BGRX8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 354 | *drm_modifier = 0; |
| 355 | break; |
| 356 | case SDE_PIX_FMT_ABGR_8888: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 357 | *drm_pixfmt = DRM_FORMAT_RGBA8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 358 | *drm_modifier = 0; |
| 359 | break; |
| 360 | case SDE_PIX_FMT_XBGR_8888: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 361 | *drm_pixfmt = DRM_FORMAT_RGBX8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 362 | *drm_modifier = 0; |
| 363 | break; |
| 364 | case SDE_PIX_FMT_ARGB_2101010: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 365 | *drm_pixfmt = DRM_FORMAT_BGRA1010102; |
| 366 | *drm_modifier = 0; |
| 367 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 368 | case SDE_PIX_FMT_XRGB_2101010: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 369 | *drm_pixfmt = DRM_FORMAT_BGRX1010102; |
| 370 | *drm_modifier = 0; |
| 371 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 372 | case SDE_PIX_FMT_ABGR_2101010: |
| 373 | *drm_pixfmt = DRM_FORMAT_RGBA1010102; |
| 374 | *drm_modifier = 0; |
| 375 | break; |
| 376 | case SDE_PIX_FMT_XBGR_2101010: |
| 377 | *drm_pixfmt = DRM_FORMAT_RGBX1010102; |
| 378 | *drm_modifier = 0; |
| 379 | break; |
| 380 | case SDE_PIX_FMT_BGRA_1010102: |
| 381 | *drm_pixfmt = DRM_FORMAT_ARGB2101010; |
| 382 | *drm_modifier = 0; |
| 383 | break; |
| 384 | case SDE_PIX_FMT_BGRX_1010102: |
| 385 | *drm_pixfmt = DRM_FORMAT_XRGB2101010; |
| 386 | *drm_modifier = 0; |
| 387 | break; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 388 | case SDE_PIX_FMT_RGBA_8888_TILE: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 389 | *drm_pixfmt = DRM_FORMAT_ABGR8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 390 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE; |
| 391 | break; |
| 392 | case SDE_PIX_FMT_RGBX_8888_TILE: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 393 | *drm_pixfmt = DRM_FORMAT_XBGR8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 394 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE; |
| 395 | break; |
| 396 | case SDE_PIX_FMT_BGRA_8888_TILE: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 397 | *drm_pixfmt = DRM_FORMAT_ARGB8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 398 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE; |
| 399 | break; |
| 400 | case SDE_PIX_FMT_BGRX_8888_TILE: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 401 | *drm_pixfmt = DRM_FORMAT_XRGB8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 402 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE; |
| 403 | break; |
| 404 | case SDE_PIX_FMT_Y_CRCB_H2V2_TILE: |
| 405 | *drm_pixfmt = DRM_FORMAT_NV21; |
| 406 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE; |
| 407 | break; |
| 408 | case SDE_PIX_FMT_Y_CBCR_H2V2_TILE: |
| 409 | *drm_pixfmt = DRM_FORMAT_NV12; |
| 410 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE; |
| 411 | break; |
| 412 | case SDE_PIX_FMT_ARGB_8888_TILE: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 413 | *drm_pixfmt = DRM_FORMAT_BGRA8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 414 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE; |
| 415 | break; |
| 416 | case SDE_PIX_FMT_XRGB_8888_TILE: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 417 | *drm_pixfmt = DRM_FORMAT_BGRX8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 418 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE; |
| 419 | break; |
| 420 | case SDE_PIX_FMT_ABGR_8888_TILE: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 421 | *drm_pixfmt = DRM_FORMAT_RGBA8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 422 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE; |
| 423 | break; |
| 424 | case SDE_PIX_FMT_XBGR_8888_TILE: |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 425 | *drm_pixfmt = DRM_FORMAT_RGBX8888; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 426 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE; |
| 427 | break; |
| 428 | case SDE_PIX_FMT_ARGB_2101010_TILE: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 429 | *drm_pixfmt = DRM_FORMAT_BGRA1010102; |
| 430 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE; |
| 431 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 432 | case SDE_PIX_FMT_XRGB_2101010_TILE: |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 433 | *drm_pixfmt = DRM_FORMAT_BGRX1010102; |
| 434 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE; |
| 435 | break; |
Alan Kwong | 75316d9 | 2017-03-31 14:12:05 -0700 | [diff] [blame] | 436 | case SDE_PIX_FMT_ABGR_2101010_TILE: |
| 437 | *drm_pixfmt = DRM_FORMAT_RGBA1010102; |
| 438 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE; |
| 439 | break; |
| 440 | case SDE_PIX_FMT_XBGR_2101010_TILE: |
| 441 | *drm_pixfmt = DRM_FORMAT_RGBX1010102; |
| 442 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE; |
| 443 | break; |
| 444 | case SDE_PIX_FMT_BGRA_1010102_TILE: |
| 445 | *drm_pixfmt = DRM_FORMAT_ARGB2101010; |
| 446 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE; |
| 447 | break; |
| 448 | case SDE_PIX_FMT_BGRX_1010102_TILE: |
| 449 | *drm_pixfmt = DRM_FORMAT_XRGB2101010; |
| 450 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE; |
| 451 | break; |
| 452 | case SDE_PIX_FMT_RGBA_1010102_UBWC: |
| 453 | *drm_pixfmt = DRM_FORMAT_ABGR2101010; |
| 454 | *drm_modifier = DRM_FORMAT_MOD_QCOM_COMPRESSED | |
| 455 | DRM_FORMAT_MOD_QCOM_TILE; |
| 456 | break; |
| 457 | case SDE_PIX_FMT_RGBX_1010102_UBWC: |
| 458 | *drm_pixfmt = DRM_FORMAT_XBGR2101010; |
| 459 | *drm_modifier = DRM_FORMAT_MOD_QCOM_COMPRESSED | |
| 460 | DRM_FORMAT_MOD_QCOM_TILE; |
| 461 | break; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 462 | case SDE_PIX_FMT_Y_CBCR_H2V2_P010: |
| 463 | *drm_pixfmt = DRM_FORMAT_NV12; |
| 464 | *drm_modifier = DRM_FORMAT_MOD_QCOM_DX; |
| 465 | break; |
| 466 | case SDE_PIX_FMT_Y_CBCR_H2V2_P010_TILE: |
| 467 | *drm_pixfmt = DRM_FORMAT_NV12; |
| 468 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE | |
| 469 | DRM_FORMAT_MOD_QCOM_DX; |
| 470 | break; |
Alan Kwong | 87847ce | 2017-02-21 08:34:31 -0800 | [diff] [blame] | 471 | case SDE_PIX_FMT_Y_CBCR_H2V2_P010_UBWC: |
| 472 | *drm_pixfmt = DRM_FORMAT_NV12; |
| 473 | *drm_modifier = DRM_FORMAT_MOD_QCOM_COMPRESSED | |
| 474 | DRM_FORMAT_MOD_QCOM_TILE | |
| 475 | DRM_FORMAT_MOD_QCOM_DX; |
| 476 | break; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 477 | case SDE_PIX_FMT_Y_CBCR_H2V2_TP10: |
| 478 | *drm_pixfmt = DRM_FORMAT_NV12; |
| 479 | *drm_modifier = DRM_FORMAT_MOD_QCOM_TILE | |
| 480 | DRM_FORMAT_MOD_QCOM_DX | |
| 481 | DRM_FORMAT_MOD_QCOM_TIGHT; |
| 482 | break; |
| 483 | case SDE_PIX_FMT_Y_CBCR_H2V2_TP10_UBWC: |
| 484 | *drm_pixfmt = DRM_FORMAT_NV12; |
| 485 | *drm_modifier = DRM_FORMAT_MOD_QCOM_COMPRESSED | |
| 486 | DRM_FORMAT_MOD_QCOM_TILE | |
| 487 | DRM_FORMAT_MOD_QCOM_DX | |
| 488 | DRM_FORMAT_MOD_QCOM_TIGHT; |
| 489 | break; |
| 490 | default: |
| 491 | SDE_DEBUG("invalid v4l2 pixel format %c%c%c%c\n", |
| 492 | pixfmt >> 0, pixfmt >> 8, |
| 493 | pixfmt >> 16, pixfmt >> 24); |
| 494 | rc = -EINVAL; |
| 495 | break; |
| 496 | } |
| 497 | |
| 498 | return rc; |
| 499 | } |
| 500 | |
| 501 | /** |
| 502 | * sde_hw_rot_to_v4l2_buffer - convert drm buffer to v4l2 buffer |
| 503 | * @drm_pixfmt: pixel format in drm fourcc |
| 504 | * @drm_modifier: pixel format modifier |
| 505 | * @drm_addr: drm buffer address per plane |
| 506 | * @drm_len: drm buffer length per plane |
| 507 | * @drm_planes: drm buffer number of planes |
| 508 | * @v4l_addr: v4l2 buffer address per plane |
| 509 | * @v4l_len: v4l2 buffer length per plane |
| 510 | * @v4l_planes: v4l2 buffer number of planes |
| 511 | */ |
| 512 | static void sde_hw_rot_to_v4l2_buffer(u32 drm_pixfmt, u64 drm_modifier, |
| 513 | dma_addr_t *drm_addr, u32 *drm_len, u32 *drm_planes, |
| 514 | dma_addr_t *v4l_addr, u32 *v4l_len, u32 *v4l_planes) |
| 515 | { |
| 516 | int i, total_size = 0; |
| 517 | |
| 518 | for (i = 0; i < SDE_ROTATOR_INLINE_PLANE_MAX; i++) { |
| 519 | v4l_addr[i] = drm_addr[i]; |
| 520 | v4l_len[i] = drm_len[i]; |
| 521 | total_size += drm_len[i]; |
| 522 | SDE_DEBUG("drm[%d]:%pad/%x\n", i, &drm_addr[i], drm_len[i]); |
| 523 | } |
| 524 | |
| 525 | if (SDE_MODIFIER_IS_UBWC(drm_modifier)) { |
| 526 | /* v4l2 driver uses plane[0] as single ubwc buffer plane */ |
| 527 | v4l_addr[0] = drm_addr[2]; |
| 528 | v4l_len[0] = total_size; |
| 529 | *v4l_planes = 1; |
| 530 | SDE_DEBUG("v4l2[0]:%pad/%x/%d\n", &v4l_addr[0], v4l_len[0], |
| 531 | *v4l_planes); |
| 532 | } else { |
| 533 | *v4l_planes = *drm_planes; |
| 534 | } |
| 535 | } |
| 536 | |
| 537 | /** |
| 538 | * sde_hw_rot_commit - commit/execute given rotator command |
| 539 | * @hw: Pointer to rotator hardware driver |
| 540 | * @data: Pointer to command descriptor |
| 541 | * @hw_cmd: type of command to be executed |
| 542 | * return: 0 if success; error code otherwise |
| 543 | */ |
| 544 | static int sde_hw_rot_commit(struct sde_hw_rot *hw, struct sde_hw_rot_cmd *data, |
| 545 | enum sde_hw_rot_cmd_type hw_cmd) |
| 546 | { |
| 547 | struct sde_rotator_inline_cmd rot_cmd; |
| 548 | enum sde_rotator_inline_cmd_type cmd_type; |
| 549 | void *priv_handle = NULL; |
| 550 | int rc; |
| 551 | |
| 552 | if (!hw || !data) { |
| 553 | SDE_ERROR("invalid parameter\n"); |
| 554 | return -EINVAL; |
| 555 | } |
| 556 | |
| 557 | memset(&rot_cmd, 0, sizeof(struct sde_rotator_inline_cmd)); |
| 558 | |
| 559 | switch (hw_cmd) { |
| 560 | case SDE_HW_ROT_CMD_VALIDATE: |
| 561 | cmd_type = SDE_ROTATOR_INLINE_CMD_VALIDATE; |
| 562 | break; |
| 563 | case SDE_HW_ROT_CMD_COMMIT: |
| 564 | cmd_type = SDE_ROTATOR_INLINE_CMD_COMMIT; |
| 565 | break; |
| 566 | case SDE_HW_ROT_CMD_CLEANUP: |
| 567 | cmd_type = SDE_ROTATOR_INLINE_CMD_CLEANUP; |
| 568 | priv_handle = data->priv_handle; |
| 569 | break; |
| 570 | default: |
| 571 | SDE_ERROR("invalid hw rotator command %d\n", hw_cmd); |
| 572 | return -EINVAL; |
| 573 | } |
| 574 | |
| 575 | rot_cmd.video_mode = data->video_mode; |
| 576 | rot_cmd.fps = data->fps; |
Alan Kwong | 120b164 | 2017-05-01 12:36:13 -0700 | [diff] [blame^] | 577 | |
| 578 | /* |
| 579 | * DRM rotation property is specified in counter clockwise direction |
| 580 | * whereas rotator h/w rotates in clockwise direction. |
| 581 | * Convert rotation property to clockwise 90 by toggling h/v flip |
| 582 | */ |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 583 | rot_cmd.rot90 = data->rot90; |
Alan Kwong | 120b164 | 2017-05-01 12:36:13 -0700 | [diff] [blame^] | 584 | rot_cmd.hflip = data->rot90 ? !data->hflip : data->hflip; |
| 585 | rot_cmd.vflip = data->rot90 ? !data->vflip : data->vflip; |
| 586 | |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 587 | rot_cmd.secure = data->secure; |
| 588 | rot_cmd.clkrate = data->clkrate; |
Alan Kwong | 4aacd53 | 2017-02-04 18:51:33 -0800 | [diff] [blame] | 589 | rot_cmd.data_bw = 0; |
| 590 | rot_cmd.prefill_bw = data->prefill_bw; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 591 | rot_cmd.src_width = data->src_width; |
| 592 | rot_cmd.src_height = data->src_height; |
| 593 | rot_cmd.src_rect_x = data->src_rect_x; |
| 594 | rot_cmd.src_rect_y = data->src_rect_y; |
| 595 | rot_cmd.src_rect_w = data->src_rect_w; |
| 596 | rot_cmd.src_rect_h = data->src_rect_h; |
| 597 | rot_cmd.dst_writeback = data->dst_writeback; |
| 598 | rot_cmd.dst_rect_x = data->dst_rect_x; |
| 599 | rot_cmd.dst_rect_y = data->dst_rect_y; |
| 600 | rot_cmd.dst_rect_w = data->dst_rect_w; |
| 601 | rot_cmd.dst_rect_h = data->dst_rect_h; |
| 602 | rot_cmd.priv_handle = priv_handle; |
| 603 | |
| 604 | rc = sde_hw_rot_to_v4l2_pixfmt(data->src_pixel_format, |
| 605 | data->src_modifier, &rot_cmd.src_pixfmt); |
| 606 | if (rc) { |
| 607 | SDE_ERROR("invalid src format %d\n", rc); |
| 608 | return rc; |
| 609 | } |
| 610 | |
| 611 | /* calculate preferred output format during validation */ |
| 612 | if (hw_cmd == SDE_HW_ROT_CMD_VALIDATE) { |
| 613 | rc = sde_rotator_inline_get_dst_pixfmt(hw->caps->pdev, |
| 614 | rot_cmd.src_pixfmt, &rot_cmd.dst_pixfmt); |
| 615 | if (rc) { |
| 616 | SDE_ERROR("invalid src format %d\n", rc); |
| 617 | return rc; |
| 618 | } |
| 619 | |
| 620 | rc = sde_hw_rot_to_drm_pixfmt(rot_cmd.dst_pixfmt, |
| 621 | &data->dst_pixel_format, &data->dst_modifier); |
| 622 | if (rc) { |
| 623 | SDE_ERROR("invalid dst format %c%c%c%c\n", |
| 624 | rot_cmd.dst_pixfmt >> 0, |
| 625 | rot_cmd.dst_pixfmt >> 8, |
| 626 | rot_cmd.dst_pixfmt >> 16, |
| 627 | rot_cmd.dst_pixfmt >> 24); |
| 628 | return rc; |
| 629 | } |
| 630 | |
| 631 | data->dst_format = sde_get_sde_format_ext( |
| 632 | data->dst_pixel_format, &data->dst_modifier, 1); |
| 633 | if (!data->dst_format) { |
| 634 | SDE_ERROR("failed to get dst format\n"); |
| 635 | return -EINVAL; |
| 636 | } |
| 637 | } else if (hw_cmd == SDE_HW_ROT_CMD_COMMIT) { |
| 638 | rc = sde_hw_rot_to_v4l2_pixfmt(data->dst_pixel_format, |
| 639 | data->dst_modifier, &rot_cmd.dst_pixfmt); |
| 640 | if (rc) { |
| 641 | SDE_ERROR("invalid dst format %d\n", rc); |
| 642 | return rc; |
| 643 | } |
| 644 | |
| 645 | sde_hw_rot_to_v4l2_buffer(data->src_pixel_format, |
| 646 | data->src_modifier, |
| 647 | data->src_iova, data->src_len, |
| 648 | &data->src_planes, |
| 649 | rot_cmd.src_addr, rot_cmd.src_len, |
| 650 | &rot_cmd.src_planes); |
| 651 | |
| 652 | sde_hw_rot_to_v4l2_buffer(data->dst_pixel_format, |
| 653 | data->dst_modifier, |
| 654 | data->dst_iova, data->dst_len, |
| 655 | &data->dst_planes, |
| 656 | rot_cmd.dst_addr, rot_cmd.dst_len, |
| 657 | &rot_cmd.dst_planes); |
| 658 | } |
| 659 | |
| 660 | /* only process any command if client is master or for validation */ |
| 661 | if (data->master || hw_cmd == SDE_HW_ROT_CMD_VALIDATE) { |
| 662 | SDE_DEBUG("dispatch seq:%d cmd:%d\n", data->sequence_id, |
| 663 | hw_cmd); |
| 664 | |
| 665 | rc = sde_rotator_inline_commit(hw->rot_ctx, &rot_cmd, cmd_type); |
| 666 | if (rc) { |
| 667 | SDE_ERROR("failed to commit inline rotation %d\n", rc); |
| 668 | return rc; |
| 669 | } |
| 670 | |
| 671 | /* return to caller */ |
| 672 | data->priv_handle = rot_cmd.priv_handle; |
| 673 | } else { |
| 674 | SDE_DEBUG("bypass seq:%d cmd:%d\n", data->sequence_id, hw_cmd); |
| 675 | } |
| 676 | |
| 677 | return 0; |
| 678 | } |
| 679 | |
| 680 | /** |
| 681 | * sde_hw_rot_get_format_caps - get pixel format capability |
| 682 | * @hw: Pointer to rotator hardware driver |
| 683 | * return: Pointer to pixel format capability array: NULL otherwise |
| 684 | */ |
| 685 | static const struct sde_format_extended *sde_hw_rot_get_format_caps( |
| 686 | struct sde_hw_rot *hw) |
| 687 | { |
| 688 | int rc, i, j, len; |
| 689 | u32 *v4l_pixfmts; |
| 690 | struct sde_format_extended *drm_pixfmts; |
| 691 | struct platform_device *pdev; |
| 692 | |
| 693 | if (!hw || !hw->caps || !hw->caps->pdev) { |
| 694 | SDE_ERROR("invalid rotator hw\n"); |
| 695 | return NULL; |
| 696 | } |
| 697 | |
| 698 | pdev = hw->caps->pdev; |
| 699 | |
| 700 | if (hw->format_caps) |
| 701 | return hw->format_caps; |
| 702 | |
| 703 | len = sde_rotator_inline_get_pixfmt_caps(pdev, true, NULL, 0); |
| 704 | if (len < 0) { |
| 705 | SDE_ERROR("invalid pixfmt caps %d\n", len); |
| 706 | return NULL; |
| 707 | } |
| 708 | |
| 709 | v4l_pixfmts = kcalloc(len, sizeof(u32), GFP_KERNEL); |
| 710 | if (!v4l_pixfmts) |
| 711 | goto done; |
| 712 | |
| 713 | sde_rotator_inline_get_pixfmt_caps(pdev, true, v4l_pixfmts, len); |
| 714 | |
| 715 | /* allocate one more to indicate termination */ |
| 716 | drm_pixfmts = kzalloc((len + 1) * sizeof(struct sde_format_extended), |
| 717 | GFP_KERNEL); |
| 718 | if (!drm_pixfmts) |
| 719 | goto done; |
| 720 | |
| 721 | for (i = 0, j = 0; i < len; i++) { |
| 722 | rc = sde_hw_rot_to_drm_pixfmt(v4l_pixfmts[i], |
| 723 | &drm_pixfmts[j].fourcc_format, |
| 724 | &drm_pixfmts[j].modifier); |
| 725 | if (!rc) { |
| 726 | SDE_DEBUG("%d: vl42:%c%c%c%c => drm:%c%c%c%c/0x%llx\n", |
| 727 | i, v4l_pixfmts[i] >> 0, v4l_pixfmts[i] >> 8, |
| 728 | v4l_pixfmts[i] >> 16, v4l_pixfmts[i] >> 24, |
| 729 | drm_pixfmts[j].fourcc_format >> 0, |
| 730 | drm_pixfmts[j].fourcc_format >> 8, |
| 731 | drm_pixfmts[j].fourcc_format >> 16, |
| 732 | drm_pixfmts[j].fourcc_format >> 24, |
| 733 | drm_pixfmts[j].modifier); |
| 734 | j++; |
| 735 | } else { |
| 736 | SDE_DEBUG("%d: vl42:%c%c%c%c not mapped\n", |
| 737 | i, v4l_pixfmts[i] >> 0, v4l_pixfmts[i] >> 8, |
| 738 | v4l_pixfmts[i] >> 16, v4l_pixfmts[i] >> 24); |
| 739 | } |
| 740 | } |
| 741 | |
| 742 | hw->format_caps = drm_pixfmts; |
| 743 | done: |
| 744 | kfree(v4l_pixfmts); |
| 745 | |
| 746 | return hw->format_caps; |
| 747 | } |
| 748 | |
| 749 | /** |
| 750 | * sde_hw_rot_get_downscale_caps - get scaling capability string |
| 751 | * @hw: Pointer to rotator hardware driver |
| 752 | * return: Pointer to capability string: NULL otherwise |
| 753 | */ |
| 754 | static const char *sde_hw_rot_get_downscale_caps(struct sde_hw_rot *hw) |
| 755 | { |
| 756 | int len; |
| 757 | struct platform_device *pdev; |
| 758 | |
| 759 | if (!hw || !hw->caps || !hw->caps->pdev) { |
| 760 | SDE_ERROR("invalid rotator hw\n"); |
| 761 | return NULL; |
| 762 | } |
| 763 | |
| 764 | pdev = hw->caps->pdev; |
| 765 | |
| 766 | if (hw->downscale_caps) |
| 767 | return hw->downscale_caps; |
| 768 | |
| 769 | len = sde_rotator_inline_get_downscale_caps(pdev, NULL, 0); |
| 770 | if (len < 0) { |
| 771 | SDE_ERROR("invalid scaling caps %d\n", len); |
| 772 | return NULL; |
| 773 | } |
| 774 | |
| 775 | /* add one for ending zero */ |
| 776 | len += 1; |
| 777 | hw->downscale_caps = kzalloc(len, GFP_KERNEL); |
| 778 | sde_rotator_inline_get_downscale_caps(pdev, hw->downscale_caps, len); |
| 779 | |
| 780 | return hw->downscale_caps; |
| 781 | } |
| 782 | |
| 783 | /** |
| 784 | * sde_hw_rot_get_cache_size - get cache size |
| 785 | * @hw: Pointer to rotator hardware driver |
| 786 | * return: size of cache |
| 787 | */ |
| 788 | static size_t sde_hw_rot_get_cache_size(struct sde_hw_rot *hw) |
| 789 | { |
| 790 | if (!hw || !hw->caps) { |
| 791 | SDE_ERROR("invalid rotator hw\n"); |
| 792 | return 0; |
| 793 | } |
| 794 | |
| 795 | return hw->caps->slice_size; |
| 796 | } |
| 797 | |
| 798 | /** |
Alan Kwong | 1a91580 | 2017-03-31 12:55:46 -0700 | [diff] [blame] | 799 | * sde_hw_rot_get_maxlinewidth - get maximum line width of rotator |
| 800 | * @hw: Pointer to rotator hardware driver |
| 801 | * return: maximum line width |
| 802 | */ |
| 803 | static int sde_hw_rot_get_maxlinewidth(struct sde_hw_rot *hw) |
| 804 | { |
| 805 | struct platform_device *pdev; |
| 806 | |
| 807 | if (!hw || !hw->caps || !hw->caps->pdev) { |
| 808 | SDE_ERROR("invalid rotator hw\n"); |
| 809 | return 0; |
| 810 | } |
| 811 | |
| 812 | pdev = hw->caps->pdev; |
| 813 | |
| 814 | return sde_rotator_inline_get_maxlinewidth(pdev); |
| 815 | } |
| 816 | |
| 817 | /** |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 818 | * _setup_rot_ops - setup rotator operations |
| 819 | * @ops: Pointer to operation table |
| 820 | * @features: available feature bitmask |
| 821 | * return: none |
| 822 | */ |
| 823 | static void _setup_rot_ops(struct sde_hw_rot_ops *ops, unsigned long features) |
| 824 | { |
| 825 | ops->commit = sde_hw_rot_commit; |
| 826 | ops->get_format_caps = sde_hw_rot_get_format_caps; |
| 827 | ops->get_downscale_caps = sde_hw_rot_get_downscale_caps; |
| 828 | ops->get_cache_size = sde_hw_rot_get_cache_size; |
Alan Kwong | 1a91580 | 2017-03-31 12:55:46 -0700 | [diff] [blame] | 829 | ops->get_maxlinewidth = sde_hw_rot_get_maxlinewidth; |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 830 | } |
| 831 | |
| 832 | /** |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 833 | * sde_hw_rot_blk_stop - stop rotator block |
| 834 | * @hw_blk: Pointer to base hardware block |
| 835 | * return: none |
| 836 | */ |
| 837 | static void sde_hw_rot_blk_stop(struct sde_hw_blk *hw_blk) |
| 838 | { |
| 839 | struct sde_hw_rot *hw_rot = to_sde_hw_rot(hw_blk); |
| 840 | |
| 841 | SDE_DEBUG("type:%d id:%d\n", hw_blk->type, hw_blk->id); |
| 842 | |
| 843 | sde_hw_rot_stop(hw_rot); |
| 844 | } |
| 845 | |
| 846 | /** |
| 847 | * sde_hw_rot_blk_start - art rotator block |
| 848 | * @hw_blk: Pointer to base hardware block |
| 849 | * return: 0 if success; error code otherwise |
| 850 | */ |
| 851 | static int sde_hw_rot_blk_start(struct sde_hw_blk *hw_blk) |
| 852 | { |
| 853 | struct sde_hw_rot *hw_rot = to_sde_hw_rot(hw_blk); |
| 854 | int rc = 0; |
| 855 | |
| 856 | SDE_DEBUG("type:%d id:%d\n", hw_blk->type, hw_blk->id); |
| 857 | |
| 858 | rc = sde_hw_rot_start(hw_rot); |
| 859 | |
| 860 | return rc; |
| 861 | } |
| 862 | |
Alan Kwong | cdb2f28 | 2017-03-18 13:42:06 -0700 | [diff] [blame] | 863 | static struct sde_hw_blk_ops sde_hw_rot_ops = { |
| 864 | .start = sde_hw_rot_blk_start, |
| 865 | .stop = sde_hw_rot_blk_stop, |
| 866 | }; |
| 867 | |
| 868 | /** |
| 869 | * sde_hw_rot_init - create/initialize given rotator instance |
| 870 | * @idx: index of given rotator |
| 871 | * @addr: i/o address mapping |
| 872 | * @m: Pointer to mdss catalog |
| 873 | * return: Pointer to hardware rotator driver of the given instance |
| 874 | */ |
| 875 | struct sde_hw_rot *sde_hw_rot_init(enum sde_rot idx, |
| 876 | void __iomem *addr, |
| 877 | struct sde_mdss_cfg *m) |
| 878 | { |
| 879 | struct sde_hw_rot *c; |
| 880 | struct sde_rot_cfg *cfg; |
| 881 | int rc; |
| 882 | |
| 883 | c = kzalloc(sizeof(*c), GFP_KERNEL); |
| 884 | if (!c) |
| 885 | return ERR_PTR(-ENOMEM); |
| 886 | |
| 887 | cfg = _rot_offset(idx, m, addr, &c->hw); |
| 888 | if (IS_ERR(cfg)) { |
| 889 | WARN(1, "Unable to find rot idx=%d\n", idx); |
| 890 | kfree(c); |
| 891 | return ERR_PTR(-EINVAL); |
| 892 | } |
| 893 | |
| 894 | /* Assign ops */ |
| 895 | c->idx = idx; |
| 896 | c->caps = cfg; |
| 897 | _setup_rot_ops(&c->ops, c->caps->features); |
| 898 | |
| 899 | rc = sde_hw_blk_init(&c->base, SDE_HW_BLK_ROT, idx, |
| 900 | &sde_hw_rot_ops); |
| 901 | if (rc) { |
| 902 | SDE_ERROR("failed to init hw blk %d\n", rc); |
| 903 | goto blk_init_error; |
| 904 | } |
| 905 | |
| 906 | return c; |
| 907 | |
| 908 | blk_init_error: |
| 909 | kzfree(c); |
| 910 | |
| 911 | return ERR_PTR(rc); |
| 912 | } |
| 913 | |
| 914 | /** |
| 915 | * sde_hw_rot_destroy - destroy given hardware rotator driver |
| 916 | * @hw_rot: Pointer to hardware rotator driver |
| 917 | * return: none |
| 918 | */ |
| 919 | void sde_hw_rot_destroy(struct sde_hw_rot *hw_rot) |
| 920 | { |
| 921 | sde_hw_blk_destroy(&hw_rot->base); |
| 922 | kfree(hw_rot->downscale_caps); |
| 923 | kfree(hw_rot->format_caps); |
| 924 | kfree(hw_rot); |
| 925 | } |
| 926 | |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 927 | struct sde_hw_rot *sde_hw_rot_get(struct sde_hw_rot *hw_rot) |
| 928 | { |
| 929 | struct sde_hw_blk *hw_blk = sde_hw_blk_get(hw_rot ? &hw_rot->base : |
| 930 | NULL, SDE_HW_BLK_ROT, -1); |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 931 | |
Alan Kwong | cdb2f28 | 2017-03-18 13:42:06 -0700 | [diff] [blame] | 932 | return IS_ERR_OR_NULL(hw_blk) ? NULL : to_sde_hw_rot(hw_blk); |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 933 | } |
| 934 | |
| 935 | void sde_hw_rot_put(struct sde_hw_rot *hw_rot) |
| 936 | { |
| 937 | struct sde_hw_blk *hw_blk = hw_rot ? &hw_rot->base : NULL; |
| 938 | |
Alan Kwong | cdb2f28 | 2017-03-18 13:42:06 -0700 | [diff] [blame] | 939 | sde_hw_blk_put(hw_blk); |
Alan Kwong | 4dd64c8 | 2017-02-04 18:41:51 -0800 | [diff] [blame] | 940 | } |