This will be useful to write tests that depends on these formats.

ARGB and XRGB follows the a similar implementation of the former formats.
Just adjusting for 16 bits per channel.

Signed-off-by: Igor Torrente <igormtorre...@gmail.com>
---
V3: Adapt the handlers to the new format introduced in patch 7 V3.
---
 drivers/gpu/drm/vkms/vkms_formats.c   | 67 +++++++++++++++++++++++++++
 drivers/gpu/drm/vkms/vkms_formats.h   | 12 +++++
 drivers/gpu/drm/vkms/vkms_plane.c     |  5 +-
 drivers/gpu/drm/vkms/vkms_writeback.c |  2 +
 4 files changed, 85 insertions(+), 1 deletion(-)

diff --git a/drivers/gpu/drm/vkms/vkms_formats.c 
b/drivers/gpu/drm/vkms/vkms_formats.c
index 0d1838d1b835..661da39d1276 100644
--- a/drivers/gpu/drm/vkms/vkms_formats.c
+++ b/drivers/gpu/drm/vkms/vkms_formats.c
@@ -7,6 +7,10 @@ format_transform_func get_fmt_transform_function(u32 format)
 {
        if (format == DRM_FORMAT_ARGB8888)
                return &ARGB8888_to_ARGB16161616;
+       else if (format == DRM_FORMAT_ARGB16161616)
+               return &get_ARGB16161616;
+       else if (format == DRM_FORMAT_XRGB16161616)
+               return &XRGB16161616_to_ARGB16161616;
        else
                return &XRGB8888_to_ARGB16161616;
 }
@@ -15,6 +19,10 @@ format_transform_func get_wb_fmt_transform_function(u32 
format)
 {
        if (format == DRM_FORMAT_ARGB8888)
                return &convert_to_ARGB8888;
+       else if (format == DRM_FORMAT_ARGB16161616)
+               return &convert_to_ARGB16161616;
+       else if (format == DRM_FORMAT_XRGB16161616)
+               return &convert_to_XRGB16161616;
        else
                return &convert_to_XRGB8888;
 }
@@ -89,6 +97,35 @@ void XRGB8888_to_ARGB16161616(struct vkms_frame_info 
*frame_info, int y,
        }
 }
 
+void get_ARGB16161616(struct vkms_frame_info *frame_info, int y,
+                     struct line_buffer *stage_buffer)
+{
+       u16 *src_pixels = get_packed_src_addr(frame_info, y);
+       int x, x_limit = drm_rect_width(&frame_info->dst);
+
+       for (x = 0; x < x_limit; x++, src_pixels += 4) {
+               stage_buffer[x].a = src_pixels[3];
+               stage_buffer[x].r = src_pixels[2];
+               stage_buffer[x].g = src_pixels[1];
+               stage_buffer[x].b = src_pixels[0];
+       }
+}
+
+void XRGB16161616_to_ARGB16161616(struct vkms_frame_info *frame_info, int y,
+                                 struct line_buffer *stage_buffer)
+{
+       u16 *src_pixels = get_packed_src_addr(frame_info, y);
+       int x, x_limit = drm_rect_width(&frame_info->dst);
+
+       for (x = 0; x < x_limit; x++, src_pixels += 4) {
+               stage_buffer[x].a = (u16)0xffff;
+               stage_buffer[x].r = src_pixels[2];
+               stage_buffer[x].g = src_pixels[1];
+               stage_buffer[x].b = src_pixels[0];
+       }
+}
+
+
 /*
  * The following  functions take an line of ARGB16161616 pixels from the
  * src_buffer, convert them to a specific format, and store them in the
@@ -136,3 +173,33 @@ void convert_to_XRGB8888(struct vkms_frame_info 
*frame_info,
                dst_pixels[0] = DIV_ROUND_UP(src_buffer[x].b, 257);
        }
 }
+
+void convert_to_ARGB16161616(struct vkms_frame_info *frame_info, int y,
+                            struct line_buffer *src_buffer)
+{
+       int x, x_dst = frame_info->dst.x1;
+       u16 *dst_pixels = packed_pixels_addr(frame_info, x_dst, y);
+       int x_limit = drm_rect_width(&frame_info->dst);
+
+       for (x = 0; x < x_limit; x++, dst_pixels += 4) {
+               dst_pixels[3] = src_buffer[x].a;
+               dst_pixels[2] = src_buffer[x].r;
+               dst_pixels[1] = src_buffer[x].g;
+               dst_pixels[0] = src_buffer[x].b;
+       }
+}
+
+void convert_to_XRGB16161616(struct vkms_frame_info *frame_info, int y,
+                            struct line_buffer *src_buffer)
+{
+       int x, x_dst = frame_info->dst.x1;
+       u16 *dst_pixels = packed_pixels_addr(frame_info, x_dst, y);
+       int x_limit = drm_rect_width(&frame_info->dst);
+
+       for (x = 0; x < x_limit; x++, dst_pixels += 4) {
+               dst_pixels[3] = src_buffer[x].a;
+               dst_pixels[2] = src_buffer[x].r;
+               dst_pixels[1] = src_buffer[x].g;
+               dst_pixels[0] = src_buffer[x].b;
+       }
+}
diff --git a/drivers/gpu/drm/vkms/vkms_formats.h 
b/drivers/gpu/drm/vkms/vkms_formats.h
index 817e8b2124ae..22358f3a33ab 100644
--- a/drivers/gpu/drm/vkms/vkms_formats.h
+++ b/drivers/gpu/drm/vkms/vkms_formats.h
@@ -15,12 +15,24 @@ void ARGB8888_to_ARGB16161616(struct vkms_frame_info 
*frame_info, int y,
 void XRGB8888_to_ARGB16161616(struct vkms_frame_info *frame_info, int y,
                              struct line_buffer *stage_buffer);
 
+void get_ARGB16161616(struct vkms_frame_info *frame_info, int y,
+                     struct line_buffer *stage_buffer);
+
+void XRGB16161616_to_ARGB16161616(struct vkms_frame_info *frame_info, int y,
+                                 struct line_buffer *stage_buffer);
+
 void convert_to_ARGB8888(struct vkms_frame_info *frame_info, int y,
                         struct line_buffer *src_buffer);
 
 void convert_to_XRGB8888(struct vkms_frame_info *frame_info, int y,
                         struct line_buffer *src_buffer);
 
+void convert_to_ARGB16161616(struct vkms_frame_info *frame_info, int y,
+                            struct line_buffer *src_buffer);
+
+void convert_to_XRGB16161616(struct vkms_frame_info *frame_info, int y,
+                            struct line_buffer *src_buffer);
+
 typedef void (*format_transform_func)(struct vkms_frame_info *frame_info, int 
y,
                                      struct line_buffer *buffer);
 
diff --git a/drivers/gpu/drm/vkms/vkms_plane.c 
b/drivers/gpu/drm/vkms/vkms_plane.c
index 28752af0118c..1d70c9e8f109 100644
--- a/drivers/gpu/drm/vkms/vkms_plane.c
+++ b/drivers/gpu/drm/vkms/vkms_plane.c
@@ -13,11 +13,14 @@
 
 static const u32 vkms_formats[] = {
        DRM_FORMAT_XRGB8888,
+       DRM_FORMAT_XRGB16161616
 };
 
 static const u32 vkms_plane_formats[] = {
        DRM_FORMAT_ARGB8888,
-       DRM_FORMAT_XRGB8888
+       DRM_FORMAT_XRGB8888,
+       DRM_FORMAT_XRGB16161616,
+       DRM_FORMAT_ARGB16161616
 };
 
 static struct drm_plane_state *
diff --git a/drivers/gpu/drm/vkms/vkms_writeback.c 
b/drivers/gpu/drm/vkms/vkms_writeback.c
index ad4bb1fb37ca..393d3fc7966f 100644
--- a/drivers/gpu/drm/vkms/vkms_writeback.c
+++ b/drivers/gpu/drm/vkms/vkms_writeback.c
@@ -14,6 +14,8 @@
 
 static const u32 vkms_wb_formats[] = {
        DRM_FORMAT_XRGB8888,
+       DRM_FORMAT_XRGB16161616,
+       DRM_FORMAT_ARGB16161616
 };
 
 static const struct drm_connector_funcs vkms_wb_connector_funcs = {
-- 
2.30.2

Reply via email to