bcf8b616de
Add support to convert from XR24 to reversed monochrome for drivers that control monochromatic display panels, that only have 1 bit per pixel. The function does a line-by-line conversion doing an intermediate step first from XR24 to 8-bit grayscale and then to reversed monochrome. The drm_fb_gray8_to_mono_reversed_line() helper was based on code from drivers/gpu/drm/tiny/repaper.c driver. Signed-off-by: Javier Martinez Canillas <javierm@redhat.com> Reviewed-by: Thomas Zimmermann <tzimmermann@suse.de> Reviewed-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com> Reviewed-by: Maxime Ripard <maxime@cerno.tech> Link: https://patchwork.freedesktop.org/patch/msgid/20220214133710.3278506-3-javierm@redhat.com
704 lines
19 KiB
C
704 lines
19 KiB
C
// SPDX-License-Identifier: GPL-2.0 or MIT
|
|
/*
|
|
* Copyright (C) 2016 Noralf Trønnes
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/io.h>
|
|
|
|
#include <drm/drm_device.h>
|
|
#include <drm/drm_format_helper.h>
|
|
#include <drm/drm_framebuffer.h>
|
|
#include <drm/drm_fourcc.h>
|
|
#include <drm/drm_print.h>
|
|
#include <drm/drm_rect.h>
|
|
|
|
static unsigned int clip_offset(const struct drm_rect *clip, unsigned int pitch, unsigned int cpp)
|
|
{
|
|
return clip->y1 * pitch + clip->x1 * cpp;
|
|
}
|
|
|
|
/**
|
|
* drm_fb_clip_offset - Returns the clipping rectangles byte-offset in a framebuffer
|
|
* @pitch: Framebuffer line pitch in byte
|
|
* @format: Framebuffer format
|
|
* @clip: Clip rectangle
|
|
*
|
|
* Returns:
|
|
* The byte offset of the clip rectangle's top-left corner within the framebuffer.
|
|
*/
|
|
unsigned int drm_fb_clip_offset(unsigned int pitch, const struct drm_format_info *format,
|
|
const struct drm_rect *clip)
|
|
{
|
|
return clip_offset(clip, pitch, format->cpp[0]);
|
|
}
|
|
EXPORT_SYMBOL(drm_fb_clip_offset);
|
|
|
|
/**
|
|
* drm_fb_memcpy - Copy clip buffer
|
|
* @dst: Destination buffer
|
|
* @dst_pitch: Number of bytes between two consecutive scanlines within dst
|
|
* @vaddr: Source buffer
|
|
* @fb: DRM framebuffer
|
|
* @clip: Clip rectangle area to copy
|
|
*
|
|
* This function does not apply clipping on dst, i.e. the destination
|
|
* is at the top-left corner.
|
|
*/
|
|
void drm_fb_memcpy(void *dst, unsigned int dst_pitch, const void *vaddr,
|
|
const struct drm_framebuffer *fb, const struct drm_rect *clip)
|
|
{
|
|
unsigned int cpp = fb->format->cpp[0];
|
|
size_t len = (clip->x2 - clip->x1) * cpp;
|
|
unsigned int y, lines = clip->y2 - clip->y1;
|
|
|
|
if (!dst_pitch)
|
|
dst_pitch = len;
|
|
|
|
vaddr += clip_offset(clip, fb->pitches[0], cpp);
|
|
for (y = 0; y < lines; y++) {
|
|
memcpy(dst, vaddr, len);
|
|
vaddr += fb->pitches[0];
|
|
dst += dst_pitch;
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(drm_fb_memcpy);
|
|
|
|
/**
|
|
* drm_fb_memcpy_toio - Copy clip buffer
|
|
* @dst: Destination buffer (iomem)
|
|
* @dst_pitch: Number of bytes between two consecutive scanlines within dst
|
|
* @vaddr: Source buffer
|
|
* @fb: DRM framebuffer
|
|
* @clip: Clip rectangle area to copy
|
|
*
|
|
* This function does not apply clipping on dst, i.e. the destination
|
|
* is at the top-left corner.
|
|
*/
|
|
void drm_fb_memcpy_toio(void __iomem *dst, unsigned int dst_pitch, const void *vaddr,
|
|
const struct drm_framebuffer *fb, const struct drm_rect *clip)
|
|
{
|
|
unsigned int cpp = fb->format->cpp[0];
|
|
size_t len = (clip->x2 - clip->x1) * cpp;
|
|
unsigned int y, lines = clip->y2 - clip->y1;
|
|
|
|
if (!dst_pitch)
|
|
dst_pitch = len;
|
|
|
|
vaddr += clip_offset(clip, fb->pitches[0], cpp);
|
|
for (y = 0; y < lines; y++) {
|
|
memcpy_toio(dst, vaddr, len);
|
|
vaddr += fb->pitches[0];
|
|
dst += dst_pitch;
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(drm_fb_memcpy_toio);
|
|
|
|
/**
|
|
* drm_fb_swab - Swap bytes into clip buffer
|
|
* @dst: Destination buffer
|
|
* @dst_pitch: Number of bytes between two consecutive scanlines within dst
|
|
* @src: Source buffer
|
|
* @fb: DRM framebuffer
|
|
* @clip: Clip rectangle area to copy
|
|
* @cached: Source buffer is mapped cached (eg. not write-combined)
|
|
*
|
|
* If @cached is false a temporary buffer is used to cache one pixel line at a
|
|
* time to speed up slow uncached reads.
|
|
*
|
|
* This function does not apply clipping on dst, i.e. the destination
|
|
* is at the top-left corner.
|
|
*/
|
|
void drm_fb_swab(void *dst, unsigned int dst_pitch, const void *src,
|
|
const struct drm_framebuffer *fb, const struct drm_rect *clip,
|
|
bool cached)
|
|
{
|
|
u8 cpp = fb->format->cpp[0];
|
|
size_t len = drm_rect_width(clip) * cpp;
|
|
const u16 *src16;
|
|
const u32 *src32;
|
|
u16 *dst16;
|
|
u32 *dst32;
|
|
unsigned int x, y;
|
|
void *buf = NULL;
|
|
|
|
if (WARN_ON_ONCE(cpp != 2 && cpp != 4))
|
|
return;
|
|
|
|
if (!dst_pitch)
|
|
dst_pitch = len;
|
|
|
|
if (!cached)
|
|
buf = kmalloc(len, GFP_KERNEL);
|
|
|
|
src += clip_offset(clip, fb->pitches[0], cpp);
|
|
|
|
for (y = clip->y1; y < clip->y2; y++) {
|
|
if (buf) {
|
|
memcpy(buf, src, len);
|
|
src16 = buf;
|
|
src32 = buf;
|
|
} else {
|
|
src16 = src;
|
|
src32 = src;
|
|
}
|
|
|
|
dst16 = dst;
|
|
dst32 = dst;
|
|
|
|
for (x = clip->x1; x < clip->x2; x++) {
|
|
if (cpp == 4)
|
|
*dst32++ = swab32(*src32++);
|
|
else
|
|
*dst16++ = swab16(*src16++);
|
|
}
|
|
|
|
src += fb->pitches[0];
|
|
dst += dst_pitch;
|
|
}
|
|
|
|
kfree(buf);
|
|
}
|
|
EXPORT_SYMBOL(drm_fb_swab);
|
|
|
|
static void drm_fb_xrgb8888_to_rgb332_line(u8 *dbuf, const __le32 *sbuf, unsigned int pixels)
|
|
{
|
|
unsigned int x;
|
|
u32 pix;
|
|
|
|
for (x = 0; x < pixels; x++) {
|
|
pix = le32_to_cpu(sbuf[x]);
|
|
dbuf[x] = ((pix & 0x00e00000) >> 16) |
|
|
((pix & 0x0000e000) >> 11) |
|
|
((pix & 0x000000c0) >> 6);
|
|
}
|
|
}
|
|
|
|
/**
|
|
* drm_fb_xrgb8888_to_rgb332 - Convert XRGB8888 to RGB332 clip buffer
|
|
* @dst: RGB332 destination buffer
|
|
* @dst_pitch: Number of bytes between two consecutive scanlines within dst
|
|
* @src: XRGB8888 source buffer
|
|
* @fb: DRM framebuffer
|
|
* @clip: Clip rectangle area to copy
|
|
*
|
|
* Drivers can use this function for RGB332 devices that don't natively support XRGB8888.
|
|
*/
|
|
void drm_fb_xrgb8888_to_rgb332(void *dst, unsigned int dst_pitch, const void *src,
|
|
const struct drm_framebuffer *fb, const struct drm_rect *clip)
|
|
{
|
|
size_t width = drm_rect_width(clip);
|
|
size_t src_len = width * sizeof(u32);
|
|
unsigned int y;
|
|
void *sbuf;
|
|
|
|
if (!dst_pitch)
|
|
dst_pitch = width;
|
|
|
|
/* Use a buffer to speed up access on buffers with uncached read mapping (i.e. WC) */
|
|
sbuf = kmalloc(src_len, GFP_KERNEL);
|
|
if (!sbuf)
|
|
return;
|
|
|
|
src += clip_offset(clip, fb->pitches[0], sizeof(u32));
|
|
for (y = 0; y < drm_rect_height(clip); y++) {
|
|
memcpy(sbuf, src, src_len);
|
|
drm_fb_xrgb8888_to_rgb332_line(dst, sbuf, width);
|
|
src += fb->pitches[0];
|
|
dst += dst_pitch;
|
|
}
|
|
|
|
kfree(sbuf);
|
|
}
|
|
EXPORT_SYMBOL(drm_fb_xrgb8888_to_rgb332);
|
|
|
|
static void drm_fb_xrgb8888_to_rgb565_line(u16 *dbuf, const u32 *sbuf,
|
|
unsigned int pixels,
|
|
bool swab)
|
|
{
|
|
unsigned int x;
|
|
u16 val16;
|
|
|
|
for (x = 0; x < pixels; x++) {
|
|
val16 = ((sbuf[x] & 0x00F80000) >> 8) |
|
|
((sbuf[x] & 0x0000FC00) >> 5) |
|
|
((sbuf[x] & 0x000000F8) >> 3);
|
|
if (swab)
|
|
dbuf[x] = swab16(val16);
|
|
else
|
|
dbuf[x] = val16;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* drm_fb_xrgb8888_to_rgb565 - Convert XRGB8888 to RGB565 clip buffer
|
|
* @dst: RGB565 destination buffer
|
|
* @dst_pitch: Number of bytes between two consecutive scanlines within dst
|
|
* @vaddr: XRGB8888 source buffer
|
|
* @fb: DRM framebuffer
|
|
* @clip: Clip rectangle area to copy
|
|
* @swab: Swap bytes
|
|
*
|
|
* Drivers can use this function for RGB565 devices that don't natively
|
|
* support XRGB8888.
|
|
*/
|
|
void drm_fb_xrgb8888_to_rgb565(void *dst, unsigned int dst_pitch, const void *vaddr,
|
|
const struct drm_framebuffer *fb, const struct drm_rect *clip,
|
|
bool swab)
|
|
{
|
|
size_t linepixels = clip->x2 - clip->x1;
|
|
size_t src_len = linepixels * sizeof(u32);
|
|
size_t dst_len = linepixels * sizeof(u16);
|
|
unsigned y, lines = clip->y2 - clip->y1;
|
|
void *sbuf;
|
|
|
|
if (!dst_pitch)
|
|
dst_pitch = dst_len;
|
|
|
|
/*
|
|
* The cma memory is write-combined so reads are uncached.
|
|
* Speed up by fetching one line at a time.
|
|
*/
|
|
sbuf = kmalloc(src_len, GFP_KERNEL);
|
|
if (!sbuf)
|
|
return;
|
|
|
|
vaddr += clip_offset(clip, fb->pitches[0], sizeof(u32));
|
|
for (y = 0; y < lines; y++) {
|
|
memcpy(sbuf, vaddr, src_len);
|
|
drm_fb_xrgb8888_to_rgb565_line(dst, sbuf, linepixels, swab);
|
|
vaddr += fb->pitches[0];
|
|
dst += dst_pitch;
|
|
}
|
|
|
|
kfree(sbuf);
|
|
}
|
|
EXPORT_SYMBOL(drm_fb_xrgb8888_to_rgb565);
|
|
|
|
/**
|
|
* drm_fb_xrgb8888_to_rgb565_toio - Convert XRGB8888 to RGB565 clip buffer
|
|
* @dst: RGB565 destination buffer (iomem)
|
|
* @dst_pitch: Number of bytes between two consecutive scanlines within dst
|
|
* @vaddr: XRGB8888 source buffer
|
|
* @fb: DRM framebuffer
|
|
* @clip: Clip rectangle area to copy
|
|
* @swab: Swap bytes
|
|
*
|
|
* Drivers can use this function for RGB565 devices that don't natively
|
|
* support XRGB8888.
|
|
*/
|
|
void drm_fb_xrgb8888_to_rgb565_toio(void __iomem *dst, unsigned int dst_pitch,
|
|
const void *vaddr, const struct drm_framebuffer *fb,
|
|
const struct drm_rect *clip, bool swab)
|
|
{
|
|
size_t linepixels = clip->x2 - clip->x1;
|
|
size_t dst_len = linepixels * sizeof(u16);
|
|
unsigned y, lines = clip->y2 - clip->y1;
|
|
void *dbuf;
|
|
|
|
if (!dst_pitch)
|
|
dst_pitch = dst_len;
|
|
|
|
dbuf = kmalloc(dst_len, GFP_KERNEL);
|
|
if (!dbuf)
|
|
return;
|
|
|
|
vaddr += clip_offset(clip, fb->pitches[0], sizeof(u32));
|
|
for (y = 0; y < lines; y++) {
|
|
drm_fb_xrgb8888_to_rgb565_line(dbuf, vaddr, linepixels, swab);
|
|
memcpy_toio(dst, dbuf, dst_len);
|
|
vaddr += fb->pitches[0];
|
|
dst += dst_pitch;
|
|
}
|
|
|
|
kfree(dbuf);
|
|
}
|
|
EXPORT_SYMBOL(drm_fb_xrgb8888_to_rgb565_toio);
|
|
|
|
static void drm_fb_xrgb8888_to_rgb888_line(u8 *dbuf, const u32 *sbuf,
|
|
unsigned int pixels)
|
|
{
|
|
unsigned int x;
|
|
|
|
for (x = 0; x < pixels; x++) {
|
|
*dbuf++ = (sbuf[x] & 0x000000FF) >> 0;
|
|
*dbuf++ = (sbuf[x] & 0x0000FF00) >> 8;
|
|
*dbuf++ = (sbuf[x] & 0x00FF0000) >> 16;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* drm_fb_xrgb8888_to_rgb888 - Convert XRGB8888 to RGB888 clip buffer
|
|
* @dst: RGB888 destination buffer
|
|
* @dst_pitch: Number of bytes between two consecutive scanlines within dst
|
|
* @src: XRGB8888 source buffer
|
|
* @fb: DRM framebuffer
|
|
* @clip: Clip rectangle area to copy
|
|
*
|
|
* Drivers can use this function for RGB888 devices that don't natively
|
|
* support XRGB8888.
|
|
*/
|
|
void drm_fb_xrgb8888_to_rgb888(void *dst, unsigned int dst_pitch, const void *src,
|
|
const struct drm_framebuffer *fb, const struct drm_rect *clip)
|
|
{
|
|
size_t width = drm_rect_width(clip);
|
|
size_t src_len = width * sizeof(u32);
|
|
unsigned int y;
|
|
void *sbuf;
|
|
|
|
if (!dst_pitch)
|
|
dst_pitch = width * 3;
|
|
|
|
/* Use a buffer to speed up access on buffers with uncached read mapping (i.e. WC) */
|
|
sbuf = kmalloc(src_len, GFP_KERNEL);
|
|
if (!sbuf)
|
|
return;
|
|
|
|
src += clip_offset(clip, fb->pitches[0], sizeof(u32));
|
|
for (y = 0; y < drm_rect_height(clip); y++) {
|
|
memcpy(sbuf, src, src_len);
|
|
drm_fb_xrgb8888_to_rgb888_line(dst, sbuf, width);
|
|
src += fb->pitches[0];
|
|
dst += dst_pitch;
|
|
}
|
|
|
|
kfree(sbuf);
|
|
}
|
|
EXPORT_SYMBOL(drm_fb_xrgb8888_to_rgb888);
|
|
|
|
/**
|
|
* drm_fb_xrgb8888_to_rgb888_toio - Convert XRGB8888 to RGB888 clip buffer
|
|
* @dst: RGB565 destination buffer (iomem)
|
|
* @dst_pitch: Number of bytes between two consecutive scanlines within dst
|
|
* @vaddr: XRGB8888 source buffer
|
|
* @fb: DRM framebuffer
|
|
* @clip: Clip rectangle area to copy
|
|
*
|
|
* Drivers can use this function for RGB888 devices that don't natively
|
|
* support XRGB8888.
|
|
*/
|
|
void drm_fb_xrgb8888_to_rgb888_toio(void __iomem *dst, unsigned int dst_pitch,
|
|
const void *vaddr, const struct drm_framebuffer *fb,
|
|
const struct drm_rect *clip)
|
|
{
|
|
size_t linepixels = clip->x2 - clip->x1;
|
|
size_t dst_len = linepixels * 3;
|
|
unsigned y, lines = clip->y2 - clip->y1;
|
|
void *dbuf;
|
|
|
|
if (!dst_pitch)
|
|
dst_pitch = dst_len;
|
|
|
|
dbuf = kmalloc(dst_len, GFP_KERNEL);
|
|
if (!dbuf)
|
|
return;
|
|
|
|
vaddr += clip_offset(clip, fb->pitches[0], sizeof(u32));
|
|
for (y = 0; y < lines; y++) {
|
|
drm_fb_xrgb8888_to_rgb888_line(dbuf, vaddr, linepixels);
|
|
memcpy_toio(dst, dbuf, dst_len);
|
|
vaddr += fb->pitches[0];
|
|
dst += dst_pitch;
|
|
}
|
|
|
|
kfree(dbuf);
|
|
}
|
|
EXPORT_SYMBOL(drm_fb_xrgb8888_to_rgb888_toio);
|
|
|
|
static void drm_fb_xrgb8888_to_xrgb2101010_line(u32 *dbuf, const u32 *sbuf,
|
|
unsigned int pixels)
|
|
{
|
|
unsigned int x;
|
|
u32 val32;
|
|
|
|
for (x = 0; x < pixels; x++) {
|
|
val32 = ((sbuf[x] & 0x000000FF) << 2) |
|
|
((sbuf[x] & 0x0000FF00) << 4) |
|
|
((sbuf[x] & 0x00FF0000) << 6);
|
|
*dbuf++ = val32 | ((val32 >> 8) & 0x00300C03);
|
|
}
|
|
}
|
|
|
|
/**
|
|
* drm_fb_xrgb8888_to_xrgb2101010_toio - Convert XRGB8888 to XRGB2101010 clip
|
|
* buffer
|
|
* @dst: XRGB2101010 destination buffer (iomem)
|
|
* @dst_pitch: Number of bytes between two consecutive scanlines within dst
|
|
* @vaddr: XRGB8888 source buffer
|
|
* @fb: DRM framebuffer
|
|
* @clip: Clip rectangle area to copy
|
|
*
|
|
* Drivers can use this function for XRGB2101010 devices that don't natively
|
|
* support XRGB8888.
|
|
*/
|
|
void drm_fb_xrgb8888_to_xrgb2101010_toio(void __iomem *dst,
|
|
unsigned int dst_pitch, const void *vaddr,
|
|
const struct drm_framebuffer *fb,
|
|
const struct drm_rect *clip)
|
|
{
|
|
size_t linepixels = clip->x2 - clip->x1;
|
|
size_t dst_len = linepixels * sizeof(u32);
|
|
unsigned int y, lines = clip->y2 - clip->y1;
|
|
void *dbuf;
|
|
|
|
if (!dst_pitch)
|
|
dst_pitch = dst_len;
|
|
|
|
dbuf = kmalloc(dst_len, GFP_KERNEL);
|
|
if (!dbuf)
|
|
return;
|
|
|
|
vaddr += clip_offset(clip, fb->pitches[0], sizeof(u32));
|
|
for (y = 0; y < lines; y++) {
|
|
drm_fb_xrgb8888_to_xrgb2101010_line(dbuf, vaddr, linepixels);
|
|
memcpy_toio(dst, dbuf, dst_len);
|
|
vaddr += fb->pitches[0];
|
|
dst += dst_pitch;
|
|
}
|
|
|
|
kfree(dbuf);
|
|
}
|
|
EXPORT_SYMBOL(drm_fb_xrgb8888_to_xrgb2101010_toio);
|
|
|
|
static void drm_fb_xrgb8888_to_gray8_line(u8 *dst, const u32 *src, unsigned int pixels)
|
|
{
|
|
unsigned int x;
|
|
|
|
for (x = 0; x < pixels; x++) {
|
|
u8 r = (*src & 0x00ff0000) >> 16;
|
|
u8 g = (*src & 0x0000ff00) >> 8;
|
|
u8 b = *src & 0x000000ff;
|
|
|
|
/* ITU BT.601: Y = 0.299 R + 0.587 G + 0.114 B */
|
|
*dst++ = (3 * r + 6 * g + b) / 10;
|
|
src++;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* drm_fb_xrgb8888_to_gray8 - Convert XRGB8888 to grayscale
|
|
* @dst: 8-bit grayscale destination buffer
|
|
* @dst_pitch: Number of bytes between two consecutive scanlines within dst
|
|
* @vaddr: XRGB8888 source buffer
|
|
* @fb: DRM framebuffer
|
|
* @clip: Clip rectangle area to copy
|
|
*
|
|
* Drm doesn't have native monochrome or grayscale support.
|
|
* Such drivers can announce the commonly supported XR24 format to userspace
|
|
* and use this function to convert to the native format.
|
|
*
|
|
* Monochrome drivers will use the most significant bit,
|
|
* where 1 means foreground color and 0 background color.
|
|
*
|
|
* ITU BT.601 is used for the RGB -> luma (brightness) conversion.
|
|
*/
|
|
void drm_fb_xrgb8888_to_gray8(void *dst, unsigned int dst_pitch, const void *vaddr,
|
|
const struct drm_framebuffer *fb, const struct drm_rect *clip)
|
|
{
|
|
unsigned int linepixels = clip->x2 - clip->x1;
|
|
unsigned int len = linepixels * sizeof(u32);
|
|
unsigned int y;
|
|
void *buf;
|
|
u8 *dst8;
|
|
u32 *src32;
|
|
|
|
if (WARN_ON(fb->format->format != DRM_FORMAT_XRGB8888))
|
|
return;
|
|
|
|
if (!dst_pitch)
|
|
dst_pitch = drm_rect_width(clip);
|
|
|
|
/*
|
|
* The cma memory is write-combined so reads are uncached.
|
|
* Speed up by fetching one line at a time.
|
|
*/
|
|
buf = kmalloc(len, GFP_KERNEL);
|
|
if (!buf)
|
|
return;
|
|
|
|
vaddr += clip_offset(clip, fb->pitches[0], sizeof(u32));
|
|
for (y = clip->y1; y < clip->y2; y++) {
|
|
dst8 = dst;
|
|
src32 = memcpy(buf, vaddr, len);
|
|
drm_fb_xrgb8888_to_gray8_line(dst8, src32, linepixels);
|
|
vaddr += fb->pitches[0];
|
|
dst += dst_pitch;
|
|
}
|
|
|
|
kfree(buf);
|
|
}
|
|
EXPORT_SYMBOL(drm_fb_xrgb8888_to_gray8);
|
|
|
|
/**
|
|
* drm_fb_blit_toio - Copy parts of a framebuffer to display memory
|
|
* @dst: The display memory to copy to
|
|
* @dst_pitch: Number of bytes between two consecutive scanlines within dst
|
|
* @dst_format: FOURCC code of the display's color format
|
|
* @vmap: The framebuffer memory to copy from
|
|
* @fb: The framebuffer to copy from
|
|
* @clip: Clip rectangle area to copy
|
|
*
|
|
* This function copies parts of a framebuffer to display memory. If the
|
|
* formats of the display and the framebuffer mismatch, the blit function
|
|
* will attempt to convert between them.
|
|
*
|
|
* Returns:
|
|
* 0 on success, or
|
|
* -EINVAL if the color-format conversion failed, or
|
|
* a negative error code otherwise.
|
|
*/
|
|
int drm_fb_blit_toio(void __iomem *dst, unsigned int dst_pitch, uint32_t dst_format,
|
|
const void *vmap, const struct drm_framebuffer *fb,
|
|
const struct drm_rect *clip)
|
|
{
|
|
uint32_t fb_format = fb->format->format;
|
|
|
|
/* treat alpha channel like filler bits */
|
|
if (fb_format == DRM_FORMAT_ARGB8888)
|
|
fb_format = DRM_FORMAT_XRGB8888;
|
|
if (dst_format == DRM_FORMAT_ARGB8888)
|
|
dst_format = DRM_FORMAT_XRGB8888;
|
|
if (fb_format == DRM_FORMAT_ARGB2101010)
|
|
fb_format = DRM_FORMAT_XRGB2101010;
|
|
if (dst_format == DRM_FORMAT_ARGB2101010)
|
|
dst_format = DRM_FORMAT_XRGB2101010;
|
|
|
|
if (dst_format == fb_format) {
|
|
drm_fb_memcpy_toio(dst, dst_pitch, vmap, fb, clip);
|
|
return 0;
|
|
|
|
} else if (dst_format == DRM_FORMAT_RGB565) {
|
|
if (fb_format == DRM_FORMAT_XRGB8888) {
|
|
drm_fb_xrgb8888_to_rgb565_toio(dst, dst_pitch, vmap, fb, clip, false);
|
|
return 0;
|
|
}
|
|
} else if (dst_format == DRM_FORMAT_RGB888) {
|
|
if (fb_format == DRM_FORMAT_XRGB8888) {
|
|
drm_fb_xrgb8888_to_rgb888_toio(dst, dst_pitch, vmap, fb, clip);
|
|
return 0;
|
|
}
|
|
} else if (dst_format == DRM_FORMAT_XRGB2101010) {
|
|
if (fb_format == DRM_FORMAT_XRGB8888) {
|
|
drm_fb_xrgb8888_to_xrgb2101010_toio(dst, dst_pitch, vmap, fb, clip);
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
return -EINVAL;
|
|
}
|
|
EXPORT_SYMBOL(drm_fb_blit_toio);
|
|
|
|
static void drm_fb_gray8_to_mono_reversed_line(u8 *dst, const u8 *src, unsigned int pixels,
|
|
unsigned int start_offset, unsigned int end_len)
|
|
{
|
|
unsigned int xb, i;
|
|
|
|
for (xb = 0; xb < pixels; xb++) {
|
|
unsigned int start = 0, end = 8;
|
|
u8 byte = 0x00;
|
|
|
|
if (xb == 0 && start_offset)
|
|
start = start_offset;
|
|
|
|
if (xb == pixels - 1 && end_len)
|
|
end = end_len;
|
|
|
|
for (i = start; i < end; i++) {
|
|
unsigned int x = xb * 8 + i;
|
|
|
|
byte >>= 1;
|
|
if (src[x] >> 7)
|
|
byte |= BIT(7);
|
|
}
|
|
*dst++ = byte;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* drm_fb_xrgb8888_to_mono_reversed - Convert XRGB8888 to reversed monochrome
|
|
* @dst: reversed monochrome destination buffer
|
|
* @dst_pitch: Number of bytes between two consecutive scanlines within dst
|
|
* @src: XRGB8888 source buffer
|
|
* @fb: DRM framebuffer
|
|
* @clip: Clip rectangle area to copy
|
|
*
|
|
* DRM doesn't have native monochrome support.
|
|
* Such drivers can announce the commonly supported XR24 format to userspace
|
|
* and use this function to convert to the native format.
|
|
*
|
|
* This function uses drm_fb_xrgb8888_to_gray8() to convert to grayscale and
|
|
* then the result is converted from grayscale to reversed monohrome.
|
|
*/
|
|
void drm_fb_xrgb8888_to_mono_reversed(void *dst, unsigned int dst_pitch, const void *vaddr,
|
|
const struct drm_framebuffer *fb, const struct drm_rect *clip)
|
|
{
|
|
unsigned int linepixels = drm_rect_width(clip);
|
|
unsigned int lines = clip->y2 - clip->y1;
|
|
unsigned int cpp = fb->format->cpp[0];
|
|
unsigned int len_src32 = linepixels * cpp;
|
|
struct drm_device *dev = fb->dev;
|
|
unsigned int start_offset, end_len;
|
|
unsigned int y;
|
|
u8 *mono = dst, *gray8;
|
|
u32 *src32;
|
|
|
|
if (drm_WARN_ON(dev, fb->format->format != DRM_FORMAT_XRGB8888))
|
|
return;
|
|
|
|
/*
|
|
* The reversed mono destination buffer contains 1 bit per pixel
|
|
* and destination scanlines have to be in multiple of 8 pixels.
|
|
*/
|
|
if (!dst_pitch)
|
|
dst_pitch = DIV_ROUND_UP(linepixels, 8);
|
|
|
|
drm_WARN_ONCE(dev, dst_pitch % 8 != 0, "dst_pitch is not a multiple of 8\n");
|
|
|
|
/*
|
|
* The cma memory is write-combined so reads are uncached.
|
|
* Speed up by fetching one line at a time.
|
|
*
|
|
* Also, format conversion from XR24 to reversed monochrome
|
|
* are done line-by-line but are converted to 8-bit grayscale
|
|
* as an intermediate step.
|
|
*
|
|
* Allocate a buffer to be used for both copying from the cma
|
|
* memory and to store the intermediate grayscale line pixels.
|
|
*/
|
|
src32 = kmalloc(len_src32 + linepixels, GFP_KERNEL);
|
|
if (!src32)
|
|
return;
|
|
|
|
gray8 = (u8 *)src32 + len_src32;
|
|
|
|
/*
|
|
* For damage handling, it is possible that only parts of the source
|
|
* buffer is copied and this could lead to start and end pixels that
|
|
* are not aligned to multiple of 8.
|
|
*
|
|
* Calculate if the start and end pixels are not aligned and set the
|
|
* offsets for the reversed mono line conversion function to adjust.
|
|
*/
|
|
start_offset = clip->x1 % 8;
|
|
end_len = clip->x2 % 8;
|
|
|
|
vaddr += clip_offset(clip, fb->pitches[0], cpp);
|
|
for (y = 0; y < lines; y++) {
|
|
src32 = memcpy(src32, vaddr, len_src32);
|
|
drm_fb_xrgb8888_to_gray8_line(gray8, src32, linepixels);
|
|
drm_fb_gray8_to_mono_reversed_line(mono, gray8, dst_pitch,
|
|
start_offset, end_len);
|
|
vaddr += fb->pitches[0];
|
|
mono += dst_pitch;
|
|
}
|
|
|
|
kfree(src32);
|
|
}
|
|
EXPORT_SYMBOL(drm_fb_xrgb8888_to_mono_reversed);
|