This allows drivers to draw the pixel, and handle tiling, or specific
color formats.

Signed-off-by: Jocelyn Falempe <jfale...@redhat.com>
---
 drivers/gpu/drm/drm_panic.c | 120 +++++++++++++++++++++++-------------
 include/drm/drm_panic.h     |   9 +++
 2 files changed, 85 insertions(+), 44 deletions(-)

diff --git a/drivers/gpu/drm/drm_panic.c b/drivers/gpu/drm/drm_panic.c
index 09d7d45f80c2..94558087bba3 100644
--- a/drivers/gpu/drm/drm_panic.c
+++ b/drivers/gpu/drm/drm_panic.c
@@ -251,40 +251,54 @@ static void drm_panic_blit32(struct iosys_map *dmap, 
unsigned int dpitch,
                                iosys_map_wr(dmap, y * dpitch + x * 
sizeof(u32), u32, color);
 }
 
+static void drm_panic_blit_pixel(struct drm_scanout_buffer *sb, struct 
drm_rect *clip,
+                                const u8 *sbuf8, unsigned int spitch, u32 
color)
+{
+       unsigned int y, x;
+
+       for (y = 0; y < drm_rect_height(clip); y++)
+               for (x = 0; x < drm_rect_width(clip); x++)
+                       if (sbuf8[(y * spitch) + x / 8] & (0x80 >> (x % 8)))
+                               sb->set_pixel(sb, clip->x1 + x, clip->y1 + y, 
color);
+}
+
 /*
  * drm_panic_blit - convert a monochrome image to a linear framebuffer
- * @dmap: destination iosys_map
- * @dpitch: destination pitch in bytes
+ * @sb: destination scanout buffer
+ * @clip: destination rectangle
  * @sbuf8: source buffer, in monochrome format, 8 pixels per byte.
  * @spitch: source pitch in bytes
- * @height: height of the image to copy, in pixels
- * @width: width of the image to copy, in pixels
  * @color: foreground color, in destination format
- * @pixel_width: pixel width in bytes.
  *
  * This can be used to draw a font character, which is a monochrome image, to a
  * framebuffer in other supported format.
  */
-static void drm_panic_blit(struct iosys_map *dmap, unsigned int dpitch,
-                          const u8 *sbuf8, unsigned int spitch,
-                          unsigned int height, unsigned int width,
-                          u32 color, unsigned int pixel_width)
+static void drm_panic_blit(struct drm_scanout_buffer *sb, struct drm_rect 
*clip,
+                          const u8 *sbuf8, unsigned int spitch, u32 color)
 {
-       switch (pixel_width) {
+       struct iosys_map map;
+
+       if (sb->set_pixel)
+               return drm_panic_blit_pixel(sb, clip, sbuf8, spitch, color);
+
+       map = sb->map[0];
+       iosys_map_incr(&map, clip->y1 * sb->pitch[0] + clip->x1 * 
sb->format->cpp[0]);
+
+       switch (sb->format->cpp[0]) {
        case 2:
-               drm_panic_blit16(dmap, dpitch, sbuf8, spitch,
-                                height, width, color);
+               drm_panic_blit16(&map, sb->pitch[0], sbuf8, spitch,
+                                drm_rect_height(clip), drm_rect_width(clip), 
color);
        break;
        case 3:
-               drm_panic_blit24(dmap, dpitch, sbuf8, spitch,
-                                height, width, color);
+               drm_panic_blit24(&map, sb->pitch[0], sbuf8, spitch,
+                                drm_rect_height(clip), drm_rect_width(clip), 
color);
        break;
        case 4:
-               drm_panic_blit32(dmap, dpitch, sbuf8, spitch,
-                                height, width, color);
+               drm_panic_blit32(&map, sb->pitch[0], sbuf8, spitch,
+                                drm_rect_height(clip), drm_rect_width(clip), 
color);
        break;
        default:
-               WARN_ONCE(1, "Can't blit with pixel width %d\n", pixel_width);
+               WARN_ONCE(1, "Can't blit with pixel width %d\n", 
sb->format->cpp[0]);
        }
 }
 
@@ -328,33 +342,51 @@ static void drm_panic_fill32(struct iosys_map *dmap, 
unsigned int dpitch,
                        iosys_map_wr(dmap, y * dpitch + x * sizeof(u32), u32, 
color);
 }
 
+static void drm_panic_fill_pixel(struct drm_scanout_buffer *sb,
+                                struct drm_rect *clip,
+                                u32 color)
+{
+       unsigned int y, x;
+
+       for (y = 0; y < drm_rect_height(clip); y++)
+               for (x = 0; x < drm_rect_width(clip); x++)
+                       sb->set_pixel(sb, clip->x1 + x, clip->y1 + y, color);
+}
+
 /*
  * drm_panic_fill - Fill a rectangle with a color
- * @dmap: destination iosys_map, pointing to the top left corner of the 
rectangle
- * @dpitch: destination pitch in bytes
- * @height: height of the rectangle, in pixels
- * @width: width of the rectangle, in pixels
- * @color: color to fill the rectangle.
- * @pixel_width: pixel width in bytes
+ * @sb: destination scanout buffer
+ * @clip: destination rectangle
+ * @color: foreground color, in destination format
  *
  * Fill a rectangle with a color, in a linear framebuffer.
  */
-static void drm_panic_fill(struct iosys_map *dmap, unsigned int dpitch,
-                          unsigned int height, unsigned int width,
-                          u32 color, unsigned int pixel_width)
+static void drm_panic_fill(struct drm_scanout_buffer *sb, struct drm_rect 
*clip,
+                          u32 color)
 {
-       switch (pixel_width) {
+       struct iosys_map map;
+
+       if (sb->set_pixel)
+               return drm_panic_fill_pixel(sb, clip, color);
+
+       map = sb->map[0];
+       iosys_map_incr(&map, clip->y1 * sb->pitch[0] + clip->x1 * 
sb->format->cpp[0]);
+
+       switch (sb->format->cpp[0]) {
        case 2:
-               drm_panic_fill16(dmap, dpitch, height, width, color);
+               drm_panic_fill16(&map, sb->pitch[0], drm_rect_height(clip),
+                                drm_rect_width(clip), color);
        break;
        case 3:
-               drm_panic_fill24(dmap, dpitch, height, width, color);
+               drm_panic_fill24(&map, sb->pitch[0], drm_rect_height(clip),
+                                drm_rect_width(clip), color);
        break;
        case 4:
-               drm_panic_fill32(dmap, dpitch, height, width, color);
+               drm_panic_fill32(&map, sb->pitch[0], drm_rect_height(clip),
+                                drm_rect_width(clip), color);
        break;
        default:
-               WARN_ONCE(1, "Can't fill with pixel width %d\n", pixel_width);
+               WARN_ONCE(1, "Can't fill with pixel width %d\n", 
sb->format->cpp[0]);
        }
 }
 
@@ -387,25 +419,24 @@ static void draw_txt_rectangle(struct drm_scanout_buffer 
*sb,
        int i, j;
        const u8 *src;
        size_t font_pitch = DIV_ROUND_UP(font->width, 8);
-       struct iosys_map dst;
-       unsigned int px_width = sb->format->cpp[0];
-       int left = 0;
+       struct drm_rect rec;
 
        msg_lines = min(msg_lines,  drm_rect_height(clip) / font->height);
        for (i = 0; i < msg_lines; i++) {
                size_t line_len = min(msg[i].len, drm_rect_width(clip) / 
font->width);
 
+               rec.y1 = clip->y1 +  i * font->height;
+               rec.y2 = rec.y1 + font->height;
+               rec.x1 = clip->x1;
+
                if (centered)
-                       left = (drm_rect_width(clip) - (line_len * 
font->width)) / 2;
+                       rec.x1 += (drm_rect_width(clip) - (line_len * 
font->width)) / 2;
 
-               dst = sb->map[0];
-               iosys_map_incr(&dst, (clip->y1 + i * font->height) * 
sb->pitch[0] +
-                                    (clip->x1 + left) * px_width);
                for (j = 0; j < line_len; j++) {
                        src = get_char_bitmap(font, msg[i].txt[j], font_pitch);
-                       drm_panic_blit(&dst, sb->pitch[0], src, font_pitch,
-                                      font->height, font->width, color, 
px_width);
-                       iosys_map_incr(&dst, font->width * px_width);
+                       rec.x2 = rec.x1 + font->width;
+                       drm_panic_blit(sb, &rec, src, font_pitch, color);
+                       rec.x1 += font->width;
                }
        }
 }
@@ -420,7 +451,7 @@ static void draw_panic_static(struct drm_scanout_buffer *sb)
        u32 fg_color = CONFIG_DRM_PANIC_FOREGROUND_COLOR;
        u32 bg_color = CONFIG_DRM_PANIC_BACKGROUND_COLOR;
        const struct font_desc *font = get_default_font(sb->width, sb->height, 
NULL, NULL);
-       struct drm_rect r_logo, r_msg;
+       struct drm_rect r_screen, r_logo, r_msg;
 
        if (!font)
                return;
@@ -428,6 +459,8 @@ static void draw_panic_static(struct drm_scanout_buffer *sb)
        fg_color = convert_from_xrgb8888(fg_color, sb->format->format);
        bg_color = convert_from_xrgb8888(bg_color, sb->format->format);
 
+       r_screen = DRM_RECT_INIT(0, 0, sb->width, sb->height);
+
        r_logo = DRM_RECT_INIT(0, 0,
                               get_max_line_len(logo, logo_lines) * font->width,
                               logo_lines * font->height);
@@ -439,8 +472,7 @@ static void draw_panic_static(struct drm_scanout_buffer *sb)
        drm_rect_translate(&r_msg, (sb->width - r_msg.x2) / 2, (sb->height - 
r_msg.y2) / 2);
 
        /* Fill with the background color, and draw text on top */
-       drm_panic_fill(&sb->map[0], sb->pitch[0], sb->height, sb->width,
-                      bg_color, sb->format->cpp[0]);
+       drm_panic_fill(sb, &r_screen, bg_color);
 
        if ((r_msg.x1 >= drm_rect_width(&r_logo) || r_msg.y1 >= 
drm_rect_height(&r_logo)) &&
            drm_rect_width(&r_logo) < sb->width && drm_rect_height(&r_logo) < 
sb->height) {
diff --git a/include/drm/drm_panic.h b/include/drm/drm_panic.h
index 822dbb1aa9d6..73bb3f3d9ed9 100644
--- a/include/drm/drm_panic.h
+++ b/include/drm/drm_panic.h
@@ -50,6 +50,15 @@ struct drm_scanout_buffer {
         * @pitch: Length in bytes between the start of two consecutive lines.
         */
        unsigned int pitch[DRM_FORMAT_MAX_PLANES];
+
+       /**
+        * @set_pixel: Optional function, to set a pixel color on the
+        * framebuffer. It allows to handle special tiling format inside the
+        * driver.
+        */
+       void (*set_pixel)(struct drm_scanout_buffer *sb, unsigned int x,
+                         unsigned int y, u32 color);
+
 };
 
 /**
-- 
2.45.0

Reply via email to