[deliverable/linux.git] / drivers / gpu / drm / udl / udl_fb.c

/*
 * Copyright (C) 2012 Red Hat
 *
 * based in parts on udlfb.c:
 * Copyright (C) 2009 Roberto De Ioris <roberto@unbit.it>
 * Copyright (C) 2009 Jaya Kumar <jayakumar.lkml@gmail.com>
 * Copyright (C) 2009 Bernie Thompson <bernie@plugable.com>
 *
 * This file is subject to the terms and conditions of the GNU General Public
 * License v2. See the file COPYING in the main directory of this archive for
 * more details.
 */
#include <linux/module.h>
#include <linux/slab.h>
#include <linux/fb.h>
#include <linux/dma-buf.h>

#include <drm/drmP.h>
#include <drm/drm_crtc.h>
#include <drm/drm_crtc_helper.h>
#include "udl_drv.h"

#include <drm/drm_fb_helper.h>

#define DL_DEFIO_WRITE_DELAY    (HZ/20) /* fb_deferred_io.delay in jiffies */

static int fb_defio = 0;  /* Optionally enable experimental fb_defio mmap support */
static int fb_bpp = 16;

module_param(fb_bpp, int, S_IWUSR | S_IRUSR | S_IWGRP | S_IRGRP);
module_param(fb_defio, int, S_IWUSR | S_IRUSR | S_IWGRP | S_IRGRP);

struct udl_fbdev {
	struct drm_fb_helper helper;
	struct udl_framebuffer ufb;
	int fb_count;
};

#define DL_ALIGN_UP(x, a) ALIGN(x, a)
#define DL_ALIGN_DOWN(x, a) ALIGN(x-(a-1), a)

/** Read the red component (0..255) of a 32 bpp colour. */
#define DLO_RGB_GETRED(col) (uint8_t)((col) & 0xFF)

/** Read the green component (0..255) of a 32 bpp colour. */
#define DLO_RGB_GETGRN(col) (uint8_t)(((col) >> 8) & 0xFF)

/** Read the blue component (0..255) of a 32 bpp colour. */
#define DLO_RGB_GETBLU(col) (uint8_t)(((col) >> 16) & 0xFF)

/** Return red/green component of a 16 bpp colour number. */
#define DLO_RG16(red, grn) (uint8_t)((((red) & 0xF8) | ((grn) >> 5)) & 0xFF)

/** Return green/blue component of a 16 bpp colour number. */
#define DLO_GB16(grn, blu) (uint8_t)(((((grn) & 0x1C) << 3) | ((blu) >> 3)) & 0xFF)

/** Return 8 bpp colour number from red, green and blue components. */
#define DLO_RGB8(red, grn, blu) ((((red) << 5) | (((grn) & 3) << 3) | ((blu) & 7)) & 0xFF)

#if 0
static uint8_t rgb8(uint32_t col)
{
	uint8_t red = DLO_RGB_GETRED(col);
	uint8_t grn = DLO_RGB_GETGRN(col);
	uint8_t blu = DLO_RGB_GETBLU(col);

	return DLO_RGB8(red, grn, blu);
}

static uint16_t rgb16(uint32_t col)
{
	uint8_t red = DLO_RGB_GETRED(col);
	uint8_t grn = DLO_RGB_GETGRN(col);
	uint8_t blu = DLO_RGB_GETBLU(col);

	return (DLO_RG16(red, grn) << 8) + DLO_GB16(grn, blu);
}
#endif

/*
 * NOTE: fb_defio.c is holding info->fbdefio.mutex
 *   Touching ANY framebuffer memory that triggers a page fault
 *   in fb_defio will cause a deadlock, when it also tries to
 *   grab the same mutex.
 */
static void udlfb_dpy_deferred_io(struct fb_info *info,
				  struct list_head *pagelist)
{
	struct page *cur;
	struct fb_deferred_io *fbdefio = info->fbdefio;
	struct udl_fbdev *ufbdev = info->par;
	struct drm_device *dev = ufbdev->ufb.base.dev;
	struct udl_device *udl = dev->dev_private;
	struct urb *urb;
	char *cmd;
	cycles_t start_cycles, end_cycles;
	int bytes_sent = 0;
	int bytes_identical = 0;
	int bytes_rendered = 0;

	if (!fb_defio)
		return;

	start_cycles = get_cycles();

	urb = udl_get_urb(dev);
	if (!urb)
		return;

	cmd = urb->transfer_buffer;

	/* walk the written page list and render each to device */
	list_for_each_entry(cur, &fbdefio->pagelist, lru) {

		if (udl_render_hline(dev, (ufbdev->ufb.base.bits_per_pixel / 8),
				     &urb, (char *) info->fix.smem_start,
				     &cmd, cur->index << PAGE_SHIFT,
				     cur->index << PAGE_SHIFT,
				     PAGE_SIZE, &bytes_identical, &bytes_sent))
			goto error;
		bytes_rendered += PAGE_SIZE;
	}

	if (cmd > (char *) urb->transfer_buffer) {
		/* Send partial buffer remaining before exiting */
		int len = cmd - (char *) urb->transfer_buffer;
		udl_submit_urb(dev, urb, len);
		bytes_sent += len;
	} else
		udl_urb_completion(urb);

error:
	atomic_add(bytes_sent, &udl->bytes_sent);
	atomic_add(bytes_identical, &udl->bytes_identical);
	atomic_add(bytes_rendered, &udl->bytes_rendered);
	end_cycles = get_cycles();
	atomic_add(((unsigned int) ((end_cycles - start_cycles)
		    >> 10)), /* Kcycles */
		   &udl->cpu_kcycles_used);
}

int udl_handle_damage(struct udl_framebuffer *fb, int x, int y,
		      int width, int height)
{
	struct drm_device *dev = fb->base.dev;
	struct udl_device *udl = dev->dev_private;
	int i, ret;
	char *cmd;
	cycles_t start_cycles, end_cycles;
	int bytes_sent = 0;
	int bytes_identical = 0;
	struct urb *urb;
	int aligned_x;
	int bpp = (fb->base.bits_per_pixel / 8);
	int x2, y2;
	bool store_for_later = false;
	unsigned long flags;

	if (!fb->active_16)
		return 0;

	if (!fb->obj->vmapping) {
		ret = udl_gem_vmap(fb->obj);
		if (ret == -ENOMEM) {
			DRM_ERROR("failed to vmap fb\n");
			return 0;
		}
		if (!fb->obj->vmapping) {
			DRM_ERROR("failed to vmapping\n");
			return 0;
		}
	}

	aligned_x = DL_ALIGN_DOWN(x, sizeof(unsigned long));
	width = DL_ALIGN_UP(width + (x-aligned_x), sizeof(unsigned long));
	x = aligned_x;

	if ((width <= 0) ||
	    (x + width > fb->base.width) ||
	    (y + height > fb->base.height))
		return -EINVAL;

	/* if we are in atomic just store the info
	   can't test inside spin lock */
	if (in_atomic())
		store_for_later = true;

	x2 = x + width - 1;
	y2 = y + height - 1;

	spin_lock_irqsave(&fb->dirty_lock, flags);

	if (fb->y1 < y)
		y = fb->y1;
	if (fb->y2 > y2)
		y2 = fb->y2;
	if (fb->x1 < x)
		x = fb->x1;
	if (fb->x2 > x2)
		x2 = fb->x2;

	if (store_for_later) {
		fb->x1 = x;
		fb->x2 = x2;
		fb->y1 = y;
		fb->y2 = y2;
		spin_unlock_irqrestore(&fb->dirty_lock, flags);
		return 0;
	}

	fb->x1 = fb->y1 = INT_MAX;
	fb->x2 = fb->y2 = 0;

	spin_unlock_irqrestore(&fb->dirty_lock, flags);
	start_cycles = get_cycles();

	urb = udl_get_urb(dev);
	if (!urb)
		return 0;
	cmd = urb->transfer_buffer;

	for (i = y; i <= y2 ; i++) {
		const int line_offset = fb->base.pitches[0] * i;
		const int byte_offset = line_offset + (x * bpp);
		const int dev_byte_offset = (fb->base.width * bpp * i) + (x * bpp);
		if (udl_render_hline(dev, bpp, &urb,
				     (char *) fb->obj->vmapping,
				     &cmd, byte_offset, dev_byte_offset,
				     (x2 - x + 1) * bpp,
				     &bytes_identical, &bytes_sent))
			goto error;
	}

	if (cmd > (char *) urb->transfer_buffer) {
		/* Send partial buffer remaining before exiting */
		int len = cmd - (char *) urb->transfer_buffer;
		ret = udl_submit_urb(dev, urb, len);
		bytes_sent += len;
	} else
		udl_urb_completion(urb);

error:
	atomic_add(bytes_sent, &udl->bytes_sent);
	atomic_add(bytes_identical, &udl->bytes_identical);
	atomic_add(width*height*bpp, &udl->bytes_rendered);
	end_cycles = get_cycles();
	atomic_add(((unsigned int) ((end_cycles - start_cycles)
		    >> 10)), /* Kcycles */
		   &udl->cpu_kcycles_used);

	return 0;
}

static int udl_fb_mmap(struct fb_info *info, struct vm_area_struct *vma)
{
	unsigned long start = vma->vm_start;
	unsigned long size = vma->vm_end - vma->vm_start;
	unsigned long offset = vma->vm_pgoff << PAGE_SHIFT;
	unsigned long page, pos;

	if (offset + size > info->fix.smem_len)
		return -EINVAL;

	pos = (unsigned long)info->fix.smem_start + offset;

	pr_notice("mmap() framebuffer addr:%lu size:%lu\n",
		  pos, size);

	while (size > 0) {
		page = vmalloc_to_pfn((void *)pos);
		if (remap_pfn_range(vma, start, page, PAGE_SIZE, PAGE_SHARED))
			return -EAGAIN;

		start += PAGE_SIZE;
		pos += PAGE_SIZE;
		if (size > PAGE_SIZE)
			size -= PAGE_SIZE;
		else
			size = 0;
	}

	/* VM_IO | VM_DONTEXPAND | VM_DONTDUMP are set by remap_pfn_range() */
	return 0;
}

static void udl_fb_fillrect(struct fb_info *info, const struct fb_fillrect *rect)
{
	struct udl_fbdev *ufbdev = info->par;

	drm_fb_helper_sys_fillrect(info, rect);

	udl_handle_damage(&ufbdev->ufb, rect->dx, rect->dy, rect->width,
			  rect->height);
}

static void udl_fb_copyarea(struct fb_info *info, const struct fb_copyarea *region)
{
	struct udl_fbdev *ufbdev = info->par;

	drm_fb_helper_sys_copyarea(info, region);

	udl_handle_damage(&ufbdev->ufb, region->dx, region->dy, region->width,
			  region->height);
}

static void udl_fb_imageblit(struct fb_info *info, const struct fb_image *image)
{
	struct udl_fbdev *ufbdev = info->par;

	drm_fb_helper_sys_imageblit(info, image);

	udl_handle_damage(&ufbdev->ufb, image->dx, image->dy, image->width,
			  image->height);
}

/*
 * It's common for several clients to have framebuffer open simultaneously.
 * e.g. both fbcon and X. Makes things interesting.
 * Assumes caller is holding info->lock (for open and release at least)
 */
static int udl_fb_open(struct fb_info *info, int user)
{
	struct udl_fbdev *ufbdev = info->par;
	struct drm_device *dev = ufbdev->ufb.base.dev;
	struct udl_device *udl = dev->dev_private;

	/* If the USB device is gone, we don't accept new opens */
	if (drm_device_is_unplugged(udl->ddev))
		return -ENODEV;

	ufbdev->fb_count++;

	if (fb_defio && (info->fbdefio == NULL)) {
		/* enable defio at last moment if not disabled by client */

		struct fb_deferred_io *fbdefio;

		fbdefio = kmalloc(sizeof(struct fb_deferred_io), GFP_KERNEL);

		if (fbdefio) {
			fbdefio->delay = DL_DEFIO_WRITE_DELAY;
			fbdefio->deferred_io = udlfb_dpy_deferred_io;
		}

		info->fbdefio = fbdefio;
		fb_deferred_io_init(info);
	}

	pr_notice("open /dev/fb%d user=%d fb_info=%p count=%d\n",
		  info->node, user, info, ufbdev->fb_count);

	return 0;
}


/*
 * Assumes caller is holding info->lock mutex (for open and release at least)
 */
static int udl_fb_release(struct fb_info *info, int user)
{
	struct udl_fbdev *ufbdev = info->par;

	ufbdev->fb_count--;

	if ((ufbdev->fb_count == 0) && (info->fbdefio)) {
		fb_deferred_io_cleanup(info);
		kfree(info->fbdefio);
		info->fbdefio = NULL;
		info->fbops->fb_mmap = udl_fb_mmap;
	}

	pr_warn("released /dev/fb%d user=%d count=%d\n",
		info->node, user, ufbdev->fb_count);

	return 0;
}

static struct fb_ops udlfb_ops = {
	.owner = THIS_MODULE,
	.fb_check_var = drm_fb_helper_check_var,
	.fb_set_par = drm_fb_helper_set_par,
	.fb_fillrect = udl_fb_fillrect,
	.fb_copyarea = udl_fb_copyarea,
	.fb_imageblit = udl_fb_imageblit,
	.fb_pan_display = drm_fb_helper_pan_display,
	.fb_blank = drm_fb_helper_blank,
	.fb_setcmap = drm_fb_helper_setcmap,
	.fb_debug_enter = drm_fb_helper_debug_enter,
	.fb_debug_leave = drm_fb_helper_debug_leave,
	.fb_mmap = udl_fb_mmap,
	.fb_open = udl_fb_open,
	.fb_release = udl_fb_release,
};

static int udl_user_framebuffer_dirty(struct drm_framebuffer *fb,
				      struct drm_file *file,
				      unsigned flags, unsigned color,
				      struct drm_clip_rect *clips,
				      unsigned num_clips)
{
	struct udl_framebuffer *ufb = to_udl_fb(fb);
	int i;
	int ret = 0;

	drm_modeset_lock_all(fb->dev);

	if (!ufb->active_16)
		goto unlock;

	if (ufb->obj->base.import_attach) {
		ret = dma_buf_begin_cpu_access(ufb->obj->base.import_attach->dmabuf,
					       0, ufb->obj->base.size,
					       DMA_FROM_DEVICE);
		if (ret)
			goto unlock;
	}

	for (i = 0; i < num_clips; i++) {
		ret = udl_handle_damage(ufb, clips[i].x1, clips[i].y1,
				  clips[i].x2 - clips[i].x1,
				  clips[i].y2 - clips[i].y1);
		if (ret)
			break;
	}

	if (ufb->obj->base.import_attach) {
		dma_buf_end_cpu_access(ufb->obj->base.import_attach->dmabuf,
				       0, ufb->obj->base.size,
				       DMA_FROM_DEVICE);
	}

 unlock:
	drm_modeset_unlock_all(fb->dev);

	return ret;
}

static void udl_user_framebuffer_destroy(struct drm_framebuffer *fb)
{
	struct udl_framebuffer *ufb = to_udl_fb(fb);

	if (ufb->obj)
		drm_gem_object_unreference_unlocked(&ufb->obj->base);

	drm_framebuffer_cleanup(fb);
	kfree(ufb);
}

static const struct drm_framebuffer_funcs udlfb_funcs = {
	.destroy = udl_user_framebuffer_destroy,
	.dirty = udl_user_framebuffer_dirty,
};


static int
udl_framebuffer_init(struct drm_device *dev,
		     struct udl_framebuffer *ufb,
		     const struct drm_mode_fb_cmd2 *mode_cmd,
		     struct udl_gem_object *obj)
{
	int ret;

	spin_lock_init(&ufb->dirty_lock);
	ufb->obj = obj;
	drm_helper_mode_fill_fb_struct(&ufb->base, mode_cmd);
	ret = drm_framebuffer_init(dev, &ufb->base, &udlfb_funcs);
	return ret;
}


static int udlfb_create(struct drm_fb_helper *helper,
			struct drm_fb_helper_surface_size *sizes)
{
	struct udl_fbdev *ufbdev =
		container_of(helper, struct udl_fbdev, helper);
	struct drm_device *dev = ufbdev->helper.dev;
	struct fb_info *info;
	struct drm_framebuffer *fb;
	struct drm_mode_fb_cmd2 mode_cmd;
	struct udl_gem_object *obj;
	uint32_t size;
	int ret = 0;

	if (sizes->surface_bpp == 24)
		sizes->surface_bpp = 32;

	mode_cmd.width = sizes->surface_width;
	mode_cmd.height = sizes->surface_height;
	mode_cmd.pitches[0] = mode_cmd.width * ((sizes->surface_bpp + 7) / 8);

	mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
							  sizes->surface_depth);

	size = mode_cmd.pitches[0] * mode_cmd.height;
	size = ALIGN(size, PAGE_SIZE);

	obj = udl_gem_alloc_object(dev, size);
	if (!obj)
		goto out;

	ret = udl_gem_vmap(obj);
	if (ret) {
		DRM_ERROR("failed to vmap fb\n");
		goto out_gfree;
	}

	info = drm_fb_helper_alloc_fbi(helper);
	if (IS_ERR(info)) {
		ret = PTR_ERR(info);
		goto out_gfree;
	}
	info->par = ufbdev;

	ret = udl_framebuffer_init(dev, &ufbdev->ufb, &mode_cmd, obj);
	if (ret)
		goto out_destroy_fbi;

	fb = &ufbdev->ufb.base;

	ufbdev->helper.fb = fb;

	strcpy(info->fix.id, "udldrmfb");

	info->screen_base = ufbdev->ufb.obj->vmapping;
	info->fix.smem_len = size;
	info->fix.smem_start = (unsigned long)ufbdev->ufb.obj->vmapping;

	info->flags = FBINFO_DEFAULT | FBINFO_CAN_FORCE_OUTPUT;
	info->fbops = &udlfb_ops;
	drm_fb_helper_fill_fix(info, fb->pitches[0], fb->depth);
	drm_fb_helper_fill_var(info, &ufbdev->helper, sizes->fb_width, sizes->fb_height);

	DRM_DEBUG_KMS("allocated %dx%d vmal %p\n",
		      fb->width, fb->height,
		      ufbdev->ufb.obj->vmapping);

	return ret;
out_destroy_fbi:
	drm_fb_helper_release_fbi(helper);
out_gfree:
	drm_gem_object_unreference(&ufbdev->ufb.obj->base);
out:
	return ret;
}

static const struct drm_fb_helper_funcs udl_fb_helper_funcs = {
	.fb_probe = udlfb_create,
};

static void udl_fbdev_destroy(struct drm_device *dev,
			      struct udl_fbdev *ufbdev)
{
	drm_fb_helper_unregister_fbi(&ufbdev->helper);
	drm_fb_helper_release_fbi(&ufbdev->helper);
	drm_fb_helper_fini(&ufbdev->helper);
	drm_framebuffer_unregister_private(&ufbdev->ufb.base);
	drm_framebuffer_cleanup(&ufbdev->ufb.base);
	drm_gem_object_unreference_unlocked(&ufbdev->ufb.obj->base);
}

int udl_fbdev_init(struct drm_device *dev)
{
	struct udl_device *udl = dev->dev_private;
	int bpp_sel = fb_bpp;
	struct udl_fbdev *ufbdev;
	int ret;

	ufbdev = kzalloc(sizeof(struct udl_fbdev), GFP_KERNEL);
	if (!ufbdev)
		return -ENOMEM;

	udl->fbdev = ufbdev;

	drm_fb_helper_prepare(dev, &ufbdev->helper, &udl_fb_helper_funcs);

	ret = drm_fb_helper_init(dev, &ufbdev->helper,
				 1, 1);
	if (ret)
		goto free;

	ret = drm_fb_helper_single_add_all_connectors(&ufbdev->helper);
	if (ret)
		goto fini;

	/* disable all the possible outputs/crtcs before entering KMS mode */
	drm_helper_disable_unused_functions(dev);

	ret = drm_fb_helper_initial_config(&ufbdev->helper, bpp_sel);
	if (ret)
		goto fini;

	return 0;

fini:
	drm_fb_helper_fini(&ufbdev->helper);
free:
	kfree(ufbdev);
	return ret;
}

void udl_fbdev_cleanup(struct drm_device *dev)
{
	struct udl_device *udl = dev->dev_private;
	if (!udl->fbdev)
		return;

	udl_fbdev_destroy(dev, udl->fbdev);
	kfree(udl->fbdev);
	udl->fbdev = NULL;
}

void udl_fbdev_unplug(struct drm_device *dev)
{
	struct udl_device *udl = dev->dev_private;
	struct udl_fbdev *ufbdev;
	if (!udl->fbdev)
		return;

	ufbdev = udl->fbdev;
	drm_fb_helper_unlink_fbi(&ufbdev->helper);
}

struct drm_framebuffer *
udl_fb_user_fb_create(struct drm_device *dev,
		   struct drm_file *file,
		   const struct drm_mode_fb_cmd2 *mode_cmd)
{
	struct drm_gem_object *obj;
	struct udl_framebuffer *ufb;
	int ret;
	uint32_t size;

	obj = drm_gem_object_lookup(dev, file, mode_cmd->handles[0]);
	if (obj == NULL)
		return ERR_PTR(-ENOENT);

	size = mode_cmd->pitches[0] * mode_cmd->height;
	size = ALIGN(size, PAGE_SIZE);

	if (size > obj->size) {
		DRM_ERROR("object size not sufficient for fb %d %zu %d %d\n", size, obj->size, mode_cmd->pitches[0], mode_cmd->height);
		return ERR_PTR(-ENOMEM);
	}

	ufb = kzalloc(sizeof(*ufb), GFP_KERNEL);
	if (ufb == NULL)
		return ERR_PTR(-ENOMEM);

	ret = udl_framebuffer_init(dev, ufb, mode_cmd, to_udl_bo(obj));
	if (ret) {
		kfree(ufb);
		return ERR_PTR(-EINVAL);
	}
	return &ufb->base;
}
Commit	Line	Data
5320918b DA	1	/*
	2	* Copyright (C) 2012 Red Hat
	3	*
	4	* based in parts on udlfb.c:
	5	* Copyright (C) 2009 Roberto De Ioris <roberto@unbit.it>
	6	* Copyright (C) 2009 Jaya Kumar <jayakumar.lkml@gmail.com>
	7	* Copyright (C) 2009 Bernie Thompson <bernie@plugable.com>
	8	*
	9	* This file is subject to the terms and conditions of the GNU General Public
	10	* License v2. See the file COPYING in the main directory of this archive for
	11	* more details.
	12	*/
	13	#include <linux/module.h>
	14	#include <linux/slab.h>
	15	#include <linux/fb.h>
32ecd242	16	#include <linux/dma-buf.h>
5320918b	17
760285e7 DH	18	#include <drm/drmP.h>
	19	#include <drm/drm_crtc.h>
	20	#include <drm/drm_crtc_helper.h>
5320918b DA	21	#include "udl_drv.h"
5320918b DA	22
760285e7	23	#include <drm/drm_fb_helper.h>
5320918b	24
677d23b7	25	#define DL_DEFIO_WRITE_DELAY (HZ/20) /* fb_deferred_io.delay in jiffies */
5320918b	26
677d23b7	27	static int fb_defio = 0; /* Optionally enable experimental fb_defio mmap support */
5320918b DA	28	static int fb_bpp = 16;
	29
	30	module_param(fb_bpp, int, S_IWUSR \| S_IRUSR \| S_IWGRP \| S_IRGRP);
	31	module_param(fb_defio, int, S_IWUSR \| S_IRUSR \| S_IWGRP \| S_IRGRP);
	32
	33	struct udl_fbdev {
	34	struct drm_fb_helper helper;
	35	struct udl_framebuffer ufb;
5320918b DA	36	int fb_count;
	37	};
	38
	39	#define DL_ALIGN_UP(x, a) ALIGN(x, a)
	40	#define DL_ALIGN_DOWN(x, a) ALIGN(x-(a-1), a)
	41
	42	/** Read the red component (0..255) of a 32 bpp colour. */
	43	#define DLO_RGB_GETRED(col) (uint8_t)((col) & 0xFF)
	44
	45	/** Read the green component (0..255) of a 32 bpp colour. */
	46	#define DLO_RGB_GETGRN(col) (uint8_t)(((col) >> 8) & 0xFF)
	47
	48	/** Read the blue component (0..255) of a 32 bpp colour. */
	49	#define DLO_RGB_GETBLU(col) (uint8_t)(((col) >> 16) & 0xFF)
	50
	51	/** Return red/green component of a 16 bpp colour number. */
	52	#define DLO_RG16(red, grn) (uint8_t)((((red) & 0xF8) \| ((grn) >> 5)) & 0xFF)
	53
	54	/** Return green/blue component of a 16 bpp colour number. */
	55	#define DLO_GB16(grn, blu) (uint8_t)(((((grn) & 0x1C) << 3) \| ((blu) >> 3)) & 0xFF)
	56
	57	/** Return 8 bpp colour number from red, green and blue components. */
	58	#define DLO_RGB8(red, grn, blu) ((((red) << 5) \| (((grn) & 3) << 3) \| ((blu) & 7)) & 0xFF)
	59
	60	#if 0
	61	static uint8_t rgb8(uint32_t col)
	62	{
	63	uint8_t red = DLO_RGB_GETRED(col);
	64	uint8_t grn = DLO_RGB_GETGRN(col);
	65	uint8_t blu = DLO_RGB_GETBLU(col);
	66
	67	return DLO_RGB8(red, grn, blu);
	68	}
	69
	70	static uint16_t rgb16(uint32_t col)
	71	{
	72	uint8_t red = DLO_RGB_GETRED(col);
	73	uint8_t grn = DLO_RGB_GETGRN(col);
	74	uint8_t blu = DLO_RGB_GETBLU(col);
	75
	76	return (DLO_RG16(red, grn) << 8) + DLO_GB16(grn, blu);
	77	}
	78	#endif
	79
	80	/*
	81	* NOTE: fb_defio.c is holding info->fbdefio.mutex
	82	* Touching ANY framebuffer memory that triggers a page fault
	83	* in fb_defio will cause a deadlock, when it also tries to
	84	* grab the same mutex.
	85	*/
	86	static void udlfb_dpy_deferred_io(struct fb_info *info,
	87	struct list_head *pagelist)
	88	{
	89	struct page *cur;
	90	struct fb_deferred_io *fbdefio = info->fbdefio;
	91	struct udl_fbdev *ufbdev = info->par;
	92	struct drm_device *dev = ufbdev->ufb.base.dev;
	93	struct udl_device *udl = dev->dev_private;
	94	struct urb *urb;
	95	char *cmd;
	96	cycles_t start_cycles, end_cycles;
	97	int bytes_sent = 0;
	98	int bytes_identical = 0;
	99	int bytes_rendered = 0;
100
101	if (!fb_defio)
102	return;
103
104	start_cycles = get_cycles();
105
106	urb = udl_get_urb(dev);
107	if (!urb)
108	return;
109
110	cmd = urb->transfer_buffer;
111
112	/* walk the written page list and render each to device */
113	list_for_each_entry(cur, &fbdefio->pagelist, lru) {
114
115	if (udl_render_hline(dev, (ufbdev->ufb.base.bits_per_pixel / 8),
3916e1d7 DA	116	&urb, (char *) info->fix.smem_start,
	117	&cmd, cur->index << PAGE_SHIFT,
	118	cur->index << PAGE_SHIFT,
	119	PAGE_SIZE, &bytes_identical, &bytes_sent))
5320918b DA	120	goto error;
	121	bytes_rendered += PAGE_SIZE;
	122	}
	123
	124	if (cmd > (char *) urb->transfer_buffer) {
	125	/* Send partial buffer remaining before exiting */
	126	int len = cmd - (char *) urb->transfer_buffer;
	127	udl_submit_urb(dev, urb, len);
	128	bytes_sent += len;
	129	} else
	130	udl_urb_completion(urb);
	131
	132	error:
	133	atomic_add(bytes_sent, &udl->bytes_sent);
	134	atomic_add(bytes_identical, &udl->bytes_identical);
	135	atomic_add(bytes_rendered, &udl->bytes_rendered);
	136	end_cycles = get_cycles();
	137	atomic_add(((unsigned int) ((end_cycles - start_cycles)
	138	>> 10)), /* Kcycles */
	139	&udl->cpu_kcycles_used);
	140	}
	141
	142	int udl_handle_damage(struct udl_framebuffer *fb, int x, int y,
	143	int width, int height)
	144	{
	145	struct drm_device *dev = fb->base.dev;
	146	struct udl_device *udl = dev->dev_private;
	147	int i, ret;
	148	char *cmd;
	149	cycles_t start_cycles, end_cycles;
	150	int bytes_sent = 0;
	151	int bytes_identical = 0;
	152	struct urb *urb;
	153	int aligned_x;
	154	int bpp = (fb->base.bits_per_pixel / 8);
bcb39af4 DA	155	int x2, y2;
	156	bool store_for_later = false;
	157	unsigned long flags;
5320918b DA	158
	159	if (!fb->active_16)
	160	return 0;
	161
e8aa1d1e DA	162	if (!fb->obj->vmapping) {
	163	ret = udl_gem_vmap(fb->obj);
	164	if (ret == -ENOMEM) {
	165	DRM_ERROR("failed to vmap fb\n");
	166	return 0;
	167	}
	168	if (!fb->obj->vmapping) {
	169	DRM_ERROR("failed to vmapping\n");
	170	return 0;
	171	}
	172	}
5320918b	173
5320918b DA	174	aligned_x = DL_ALIGN_DOWN(x, sizeof(unsigned long));
	175	width = DL_ALIGN_UP(width + (x-aligned_x), sizeof(unsigned long));
	176	x = aligned_x;
	177
	178	if ((width <= 0) \|\|
	179	(x + width > fb->base.width) \|\|
	180	(y + height > fb->base.height))
	181	return -EINVAL;
	182
bcb39af4 DA	183	/* if we are in atomic just store the info
	184	can't test inside spin lock */
	185	if (in_atomic())
	186	store_for_later = true;
	187
	188	x2 = x + width - 1;
	189	y2 = y + height - 1;
	190
	191	spin_lock_irqsave(&fb->dirty_lock, flags);
	192
	193	if (fb->y1 < y)
	194	y = fb->y1;
	195	if (fb->y2 > y2)
	196	y2 = fb->y2;
	197	if (fb->x1 < x)
	198	x = fb->x1;
	199	if (fb->x2 > x2)
	200	x2 = fb->x2;
	201
	202	if (store_for_later) {
	203	fb->x1 = x;
	204	fb->x2 = x2;
	205	fb->y1 = y;
	206	fb->y2 = y2;
	207	spin_unlock_irqrestore(&fb->dirty_lock, flags);
	208	return 0;
	209	}
	210
	211	fb->x1 = fb->y1 = INT_MAX;
	212	fb->x2 = fb->y2 = 0;
	213
	214	spin_unlock_irqrestore(&fb->dirty_lock, flags);
	215	start_cycles = get_cycles();
	216
5320918b DA	217	urb = udl_get_urb(dev);
	218	if (!urb)
	219	return 0;
	220	cmd = urb->transfer_buffer;
	221
bcb39af4	222	for (i = y; i <= y2 ; i++) {
5320918b DA	223	const int line_offset = fb->base.pitches[0] * i;
5320918b DA	224	const int byte_offset = line_offset + (x * bpp);
3916e1d7	225	const int dev_byte_offset = (fb->base.width * bpp * i) + (x * bpp);
5320918b DA	226	if (udl_render_hline(dev, bpp, &urb,
5320918b DA	227	(char *) fb->obj->vmapping,
3916e1d7	228	&cmd, byte_offset, dev_byte_offset,
bcb39af4	229	(x2 - x + 1) * bpp,
5320918b DA	230	&bytes_identical, &bytes_sent))
	231	goto error;
	232	}
	233
	234	if (cmd > (char *) urb->transfer_buffer) {
	235	/* Send partial buffer remaining before exiting */
	236	int len = cmd - (char *) urb->transfer_buffer;
	237	ret = udl_submit_urb(dev, urb, len);
	238	bytes_sent += len;
	239	} else
	240	udl_urb_completion(urb);
	241
	242	error:
	243	atomic_add(bytes_sent, &udl->bytes_sent);
	244	atomic_add(bytes_identical, &udl->bytes_identical);
	245	atomic_add(widthheightbpp, &udl->bytes_rendered);
	246	end_cycles = get_cycles();
	247	atomic_add(((unsigned int) ((end_cycles - start_cycles)
	248	>> 10)), /* Kcycles */
	249	&udl->cpu_kcycles_used);
	250
	251	return 0;
	252	}
	253
	254	static int udl_fb_mmap(struct fb_info info, struct vm_area_struct vma)
	255	{
	256	unsigned long start = vma->vm_start;
	257	unsigned long size = vma->vm_end - vma->vm_start;
	258	unsigned long offset = vma->vm_pgoff << PAGE_SHIFT;
	259	unsigned long page, pos;
	260
	261	if (offset + size > info->fix.smem_len)
	262	return -EINVAL;
	263
	264	pos = (unsigned long)info->fix.smem_start + offset;
	265
	266	pr_notice("mmap() framebuffer addr:%lu size:%lu\n",
	267	pos, size);
	268
	269	while (size > 0) {
	270	page = vmalloc_to_pfn((void *)pos);
	271	if (remap_pfn_range(vma, start, page, PAGE_SIZE, PAGE_SHARED))
	272	return -EAGAIN;
	273
	274	start += PAGE_SIZE;
	275	pos += PAGE_SIZE;
	276	if (size > PAGE_SIZE)
	277	size -= PAGE_SIZE;
	278	else
	279	size = 0;
	280	}
	281
314e51b9	282	/* VM_IO \| VM_DONTEXPAND \| VM_DONTDUMP are set by remap_pfn_range() */
5320918b DA	283	return 0;
	284	}
	285
	286	static void udl_fb_fillrect(struct fb_info info, const struct fb_fillrect rect)
	287	{
	288	struct udl_fbdev *ufbdev = info->par;
	289
41ba2f34	290	drm_fb_helper_sys_fillrect(info, rect);
5320918b DA	291
	292	udl_handle_damage(&ufbdev->ufb, rect->dx, rect->dy, rect->width,
	293	rect->height);
	294	}
	295
	296	static void udl_fb_copyarea(struct fb_info info, const struct fb_copyarea region)
	297	{
	298	struct udl_fbdev *ufbdev = info->par;
	299
41ba2f34	300	drm_fb_helper_sys_copyarea(info, region);
5320918b DA	301
	302	udl_handle_damage(&ufbdev->ufb, region->dx, region->dy, region->width,
	303	region->height);
	304	}
	305
	306	static void udl_fb_imageblit(struct fb_info info, const struct fb_image image)
	307	{
	308	struct udl_fbdev *ufbdev = info->par;
	309
41ba2f34	310	drm_fb_helper_sys_imageblit(info, image);
5320918b DA	311
	312	udl_handle_damage(&ufbdev->ufb, image->dx, image->dy, image->width,
	313	image->height);
	314	}
	315
	316	/*
	317	* It's common for several clients to have framebuffer open simultaneously.
	318	* e.g. both fbcon and X. Makes things interesting.
	319	* Assumes caller is holding info->lock (for open and release at least)
	320	*/
	321	static int udl_fb_open(struct fb_info *info, int user)
	322	{
	323	struct udl_fbdev *ufbdev = info->par;
	324	struct drm_device *dev = ufbdev->ufb.base.dev;
	325	struct udl_device *udl = dev->dev_private;
	326
	327	/* If the USB device is gone, we don't accept new opens */
	328	if (drm_device_is_unplugged(udl->ddev))
	329	return -ENODEV;
	330
	331	ufbdev->fb_count++;
	332
	333	if (fb_defio && (info->fbdefio == NULL)) {
	334	/* enable defio at last moment if not disabled by client */
	335
	336	struct fb_deferred_io *fbdefio;
	337
	338	fbdefio = kmalloc(sizeof(struct fb_deferred_io), GFP_KERNEL);
	339
	340	if (fbdefio) {
	341	fbdefio->delay = DL_DEFIO_WRITE_DELAY;
	342	fbdefio->deferred_io = udlfb_dpy_deferred_io;
	343	}
	344
	345	info->fbdefio = fbdefio;
	346	fb_deferred_io_init(info);
	347	}
	348
	349	pr_notice("open /dev/fb%d user=%d fb_info=%p count=%d\n",
	350	info->node, user, info, ufbdev->fb_count);
	351
	352	return 0;
	353	}
	354
	355
	356	/*
	357	* Assumes caller is holding info->lock mutex (for open and release at least)
	358	*/
	359	static int udl_fb_release(struct fb_info *info, int user)
	360	{
	361	struct udl_fbdev *ufbdev = info->par;
	362
	363	ufbdev->fb_count--;
	364
	365	if ((ufbdev->fb_count == 0) && (info->fbdefio)) {
	366	fb_deferred_io_cleanup(info);
	367	kfree(info->fbdefio);
	368	info->fbdefio = NULL;
	369	info->fbops->fb_mmap = udl_fb_mmap;
	370	}
	371
	372	pr_warn("released /dev/fb%d user=%d count=%d\n",
	373	info->node, user, ufbdev->fb_count);
	374
375	return 0;
376	}
377
378	static struct fb_ops udlfb_ops = {
379	.owner = THIS_MODULE,
380	.fb_check_var = drm_fb_helper_check_var,
381	.fb_set_par = drm_fb_helper_set_par,
382	.fb_fillrect = udl_fb_fillrect,
383	.fb_copyarea = udl_fb_copyarea,
384	.fb_imageblit = udl_fb_imageblit,
385	.fb_pan_display = drm_fb_helper_pan_display,
386	.fb_blank = drm_fb_helper_blank,
387	.fb_setcmap = drm_fb_helper_setcmap,
388	.fb_debug_enter = drm_fb_helper_debug_enter,
389	.fb_debug_leave = drm_fb_helper_debug_leave,
390	.fb_mmap = udl_fb_mmap,
391	.fb_open = udl_fb_open,
392	.fb_release = udl_fb_release,
393	};
394
5320918b DA	395	static int udl_user_framebuffer_dirty(struct drm_framebuffer *fb,
	396	struct drm_file *file,
	397	unsigned flags, unsigned color,
	398	struct drm_clip_rect *clips,
	399	unsigned num_clips)
	400	{
	401	struct udl_framebuffer *ufb = to_udl_fb(fb);
	402	int i;
32ecd242	403	int ret = 0;
5320918b	404
73e9efd4 VS	405	drm_modeset_lock_all(fb->dev);
73e9efd4 VS	406
5320918b	407	if (!ufb->active_16)
73e9efd4	408	goto unlock;
5320918b	409
32ecd242 DA	410	if (ufb->obj->base.import_attach) {
	411	ret = dma_buf_begin_cpu_access(ufb->obj->base.import_attach->dmabuf,
	412	0, ufb->obj->base.size,
	413	DMA_FROM_DEVICE);
	414	if (ret)
73e9efd4	415	goto unlock;
32ecd242 DA	416	}
32ecd242 DA	417
5320918b	418	for (i = 0; i < num_clips; i++) {
32ecd242	419	ret = udl_handle_damage(ufb, clips[i].x1, clips[i].y1,
5320918b DA	420	clips[i].x2 - clips[i].x1,
5320918b DA	421	clips[i].y2 - clips[i].y1);
32ecd242	422	if (ret)
06c99161	423	break;
5320918b	424	}
32ecd242 DA	425
	426	if (ufb->obj->base.import_attach) {
	427	dma_buf_end_cpu_access(ufb->obj->base.import_attach->dmabuf,
	428	0, ufb->obj->base.size,
	429	DMA_FROM_DEVICE);
	430	}
73e9efd4 VS	431
	432	unlock:
	433	drm_modeset_unlock_all(fb->dev);
	434
32ecd242	435	return ret;
5320918b DA	436	}
	437
	438	static void udl_user_framebuffer_destroy(struct drm_framebuffer *fb)
	439	{
	440	struct udl_framebuffer *ufb = to_udl_fb(fb);
	441
	442	if (ufb->obj)
	443	drm_gem_object_unreference_unlocked(&ufb->obj->base);
	444
	445	drm_framebuffer_cleanup(fb);
	446	kfree(ufb);
	447	}
	448
	449	static const struct drm_framebuffer_funcs udlfb_funcs = {
	450	.destroy = udl_user_framebuffer_destroy,
	451	.dirty = udl_user_framebuffer_dirty,
5320918b DA	452	};
	453
	454
	455	static int
	456	udl_framebuffer_init(struct drm_device *dev,
	457	struct udl_framebuffer *ufb,
1eb83451	458	const struct drm_mode_fb_cmd2 *mode_cmd,
5320918b DA	459	struct udl_gem_object *obj)
	460	{
	461	int ret;
	462
bcb39af4	463	spin_lock_init(&ufb->dirty_lock);
5320918b	464	ufb->obj = obj;
5320918b	465	drm_helper_mode_fill_fb_struct(&ufb->base, mode_cmd);
c7d73f6a	466	ret = drm_framebuffer_init(dev, &ufb->base, &udlfb_funcs);
5320918b DA	467	return ret;
	468	}
	469
	470
cd5428a5	471	static int udlfb_create(struct drm_fb_helper *helper,
5320918b DA	472	struct drm_fb_helper_surface_size *sizes)
5320918b DA	473	{
ee0d68ab FF	474	struct udl_fbdev *ufbdev =
ee0d68ab FF	475	container_of(helper, struct udl_fbdev, helper);
5320918b DA	476	struct drm_device *dev = ufbdev->helper.dev;
5320918b DA	477	struct fb_info *info;
5320918b DA	478	struct drm_framebuffer *fb;
	479	struct drm_mode_fb_cmd2 mode_cmd;
	480	struct udl_gem_object *obj;
	481	uint32_t size;
	482	int ret = 0;
	483
	484	if (sizes->surface_bpp == 24)
	485	sizes->surface_bpp = 32;
	486
	487	mode_cmd.width = sizes->surface_width;
	488	mode_cmd.height = sizes->surface_height;
	489	mode_cmd.pitches[0] = mode_cmd.width * ((sizes->surface_bpp + 7) / 8);
	490
	491	mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
	492	sizes->surface_depth);
	493
	494	size = mode_cmd.pitches[0] * mode_cmd.height;
	495	size = ALIGN(size, PAGE_SIZE);
	496
	497	obj = udl_gem_alloc_object(dev, size);
	498	if (!obj)
	499	goto out;
	500
	501	ret = udl_gem_vmap(obj);
	502	if (ret) {
	503	DRM_ERROR("failed to vmap fb\n");
	504	goto out_gfree;
	505	}
	506
41ba2f34 AT	507	info = drm_fb_helper_alloc_fbi(helper);
	508	if (IS_ERR(info)) {
	509	ret = PTR_ERR(info);
5320918b DA	510	goto out_gfree;
	511	}
	512	info->par = ufbdev;
	513
	514	ret = udl_framebuffer_init(dev, &ufbdev->ufb, &mode_cmd, obj);
	515	if (ret)
41ba2f34	516	goto out_destroy_fbi;
5320918b DA	517
	518	fb = &ufbdev->ufb.base;
	519
	520	ufbdev->helper.fb = fb;
5320918b DA	521
	522	strcpy(info->fix.id, "udldrmfb");
	523
	524	info->screen_base = ufbdev->ufb.obj->vmapping;
	525	info->fix.smem_len = size;
	526	info->fix.smem_start = (unsigned long)ufbdev->ufb.obj->vmapping;
	527
	528	info->flags = FBINFO_DEFAULT \| FBINFO_CAN_FORCE_OUTPUT;
	529	info->fbops = &udlfb_ops;
	530	drm_fb_helper_fill_fix(info, fb->pitches[0], fb->depth);
	531	drm_fb_helper_fill_var(info, &ufbdev->helper, sizes->fb_width, sizes->fb_height);
	532
5320918b DA	533	DRM_DEBUG_KMS("allocated %dx%d vmal %p\n",
	534	fb->width, fb->height,
	535	ufbdev->ufb.obj->vmapping);
	536
	537	return ret;
41ba2f34 AT	538	out_destroy_fbi:
41ba2f34 AT	539	drm_fb_helper_release_fbi(helper);
5320918b DA	540	out_gfree:
	541	drm_gem_object_unreference(&ufbdev->ufb.obj->base);
	542	out:
	543	return ret;
	544	}
	545
3a493879	546	static const struct drm_fb_helper_funcs udl_fb_helper_funcs = {
cd5428a5	547	.fb_probe = udlfb_create,
5320918b DA	548	};
	549
	550	static void udl_fbdev_destroy(struct drm_device *dev,
	551	struct udl_fbdev *ufbdev)
	552	{
41ba2f34 AT	553	drm_fb_helper_unregister_fbi(&ufbdev->helper);
41ba2f34 AT	554	drm_fb_helper_release_fbi(&ufbdev->helper);
5320918b	555	drm_fb_helper_fini(&ufbdev->helper);
36206361	556	drm_framebuffer_unregister_private(&ufbdev->ufb.base);
5320918b DA	557	drm_framebuffer_cleanup(&ufbdev->ufb.base);
	558	drm_gem_object_unreference_unlocked(&ufbdev->ufb.obj->base);
	559	}
	560
	561	int udl_fbdev_init(struct drm_device *dev)
	562	{
	563	struct udl_device *udl = dev->dev_private;
	564	int bpp_sel = fb_bpp;
	565	struct udl_fbdev *ufbdev;
	566	int ret;
	567
	568	ufbdev = kzalloc(sizeof(struct udl_fbdev), GFP_KERNEL);
	569	if (!ufbdev)
	570	return -ENOMEM;
	571
	572	udl->fbdev = ufbdev;
10a23102 TR	573
10a23102 TR	574	drm_fb_helper_prepare(dev, &ufbdev->helper, &udl_fb_helper_funcs);
5320918b DA	575
	576	ret = drm_fb_helper_init(dev, &ufbdev->helper,
	577	1, 1);
01934c2a TR	578	if (ret)
01934c2a TR	579	goto free;
5320918b	580
01934c2a TR	581	ret = drm_fb_helper_single_add_all_connectors(&ufbdev->helper);
	582	if (ret)
	583	goto fini;
76a39dbf DV	584
	585	/* disable all the possible outputs/crtcs before entering KMS mode */
	586	drm_helper_disable_unused_functions(dev);
	587
01934c2a TR	588	ret = drm_fb_helper_initial_config(&ufbdev->helper, bpp_sel);
	589	if (ret)
	590	goto fini;
	591
5320918b	592	return 0;
01934c2a TR	593
	594	fini:
	595	drm_fb_helper_fini(&ufbdev->helper);
	596	free:
	597	kfree(ufbdev);
	598	return ret;
5320918b DA	599	}
	600
	601	void udl_fbdev_cleanup(struct drm_device *dev)
	602	{
	603	struct udl_device *udl = dev->dev_private;
	604	if (!udl->fbdev)
	605	return;
	606
	607	udl_fbdev_destroy(dev, udl->fbdev);
	608	kfree(udl->fbdev);
	609	udl->fbdev = NULL;
	610	}
	611
	612	void udl_fbdev_unplug(struct drm_device *dev)
	613	{
	614	struct udl_device *udl = dev->dev_private;
	615	struct udl_fbdev *ufbdev;
	616	if (!udl->fbdev)
	617	return;
	618
	619	ufbdev = udl->fbdev;
41ba2f34	620	drm_fb_helper_unlink_fbi(&ufbdev->helper);
5320918b DA	621	}
	622
	623	struct drm_framebuffer *
	624	udl_fb_user_fb_create(struct drm_device *dev,
	625	struct drm_file *file,
1eb83451	626	const struct drm_mode_fb_cmd2 *mode_cmd)
5320918b DA	627	{
	628	struct drm_gem_object *obj;
	629	struct udl_framebuffer *ufb;
	630	int ret;
96503f59	631	uint32_t size;
5320918b DA	632
	633	obj = drm_gem_object_lookup(dev, file, mode_cmd->handles[0]);
	634	if (obj == NULL)
	635	return ERR_PTR(-ENOENT);
	636
96503f59 DA	637	size = mode_cmd->pitches[0] * mode_cmd->height;
	638	size = ALIGN(size, PAGE_SIZE);
	639
	640	if (size > obj->size) {
	641	DRM_ERROR("object size not sufficient for fb %d %zu %d %d\n", size, obj->size, mode_cmd->pitches[0], mode_cmd->height);
	642	return ERR_PTR(-ENOMEM);
	643	}
	644
5320918b DA	645	ufb = kzalloc(sizeof(*ufb), GFP_KERNEL);
	646	if (ufb == NULL)
	647	return ERR_PTR(-ENOMEM);
	648
	649	ret = udl_framebuffer_init(dev, ufb, mode_cmd, to_udl_bo(obj));
	650	if (ret) {
	651	kfree(ufb);
	652	return ERR_PTR(-EINVAL);
	653	}
	654	return &ufb->base;
	655	}