77 static int dlfb_realloc_framebuffer(struct dlfb_data *dlfb, struct fb_info *info, u32 new_len);
81 static struct urb *dlfb_get_urb(struct dlfb_data *dlfb);
82 static int dlfb_submit_urb(struct dlfb_data *dlfb, struct urb * urb, size_t len);
83 static int dlfb_alloc_urb_list(struct dlfb_data *dlfb, int count, size_t size);
84 static void dlfb_free_urb_list(struct dlfb_data *dlfb);
279 static int dlfb_set_video_mode(struct dlfb_data *dlfb,  in dlfb_set_video_mode()  argument
288 	if (!atomic_read(&dlfb->usb_active))  in dlfb_set_video_mode()
291 	urb = dlfb_get_urb(dlfb);  in dlfb_set_video_mode()
307 	wrptr = dlfb_set_base8bpp(wrptr, dlfb->info->fix.smem_len);  in dlfb_set_video_mode()
315 	retval = dlfb_submit_urb(dlfb, urb, writesize);  in dlfb_set_video_mode()
317 	dlfb->blank_mode = FB_BLANK_UNBLANK;  in dlfb_set_video_mode()
535 static int dlfb_render_hline(struct dlfb_data *dlfb, struct urb **urb_ptr,  in dlfb_render_hline()  argument
541 	u32 dev_addr = dlfb->base16 + byte_offset;  in dlfb_render_hline()
551 	if (dlfb->backing_buffer) {  in dlfb_render_hline()
553 		const u8 *back_start = (u8 *) (dlfb->backing_buffer  in dlfb_render_hline()
577 			if (dlfb_submit_urb(dlfb, urb, len))  in dlfb_render_hline()
580 			urb = dlfb_get_urb(dlfb);  in dlfb_render_hline()
594 static int dlfb_handle_damage(struct dlfb_data *dlfb, int x, int y, int width, int height)  in dlfb_handle_damage()  argument
606 	mutex_lock(&dlfb->render_mutex);  in dlfb_handle_damage()
613 	    (x + width > dlfb->info->var.xres) ||  in dlfb_handle_damage()
614 	    (y + height > dlfb->info->var.yres)) {  in dlfb_handle_damage()
619 	if (!atomic_read(&dlfb->usb_active)) {  in dlfb_handle_damage()
624 	urb = dlfb_get_urb(dlfb);  in dlfb_handle_damage()
632 		const int line_offset = dlfb->info->fix.line_length * i;  in dlfb_handle_damage()
635 		if (dlfb_render_hline(dlfb, &urb,  in dlfb_handle_damage()
636 				      (char *) dlfb->info->fix.smem_start,  in dlfb_handle_damage()
648 		dlfb_submit_urb(dlfb, urb, len);  in dlfb_handle_damage()
654 	atomic_add(bytes_sent, &dlfb->bytes_sent);  in dlfb_handle_damage()
655 	atomic_add(bytes_identical, &dlfb->bytes_identical);  in dlfb_handle_damage()
656 	atomic_add(width*height*2, &dlfb->bytes_rendered);  in dlfb_handle_damage()
660 		   &dlfb->cpu_kcycles_used);  in dlfb_handle_damage()
665 	mutex_unlock(&dlfb->render_mutex);  in dlfb_handle_damage()
669 static void dlfb_init_damage(struct dlfb_data *dlfb)  in dlfb_init_damage()  argument
671 	dlfb->damage_x = INT_MAX;  in dlfb_init_damage()
672 	dlfb->damage_x2 = 0;  in dlfb_init_damage()
673 	dlfb->damage_y = INT_MAX;  in dlfb_init_damage()
674 	dlfb->damage_y2 = 0;  in dlfb_init_damage()
679 	struct dlfb_data *dlfb = container_of(w, struct dlfb_data, damage_work);  in dlfb_damage_work()  local
682 	spin_lock_irq(&dlfb->damage_lock);  in dlfb_damage_work()
683 	x = dlfb->damage_x;  in dlfb_damage_work()
684 	x2 = dlfb->damage_x2;  in dlfb_damage_work()
685 	y = dlfb->damage_y;  in dlfb_damage_work()
686 	y2 = dlfb->damage_y2;  in dlfb_damage_work()
687 	dlfb_init_damage(dlfb);  in dlfb_damage_work()
688 	spin_unlock_irq(&dlfb->damage_lock);  in dlfb_damage_work()
691 		dlfb_handle_damage(dlfb, x, y, x2 - x, y2 - y);  in dlfb_damage_work()
694 static void dlfb_offload_damage(struct dlfb_data *dlfb, int x, int y, int width, int height)  in dlfb_offload_damage()  argument
703 	spin_lock_irqsave(&dlfb->damage_lock, flags);  in dlfb_offload_damage()
704 	dlfb->damage_x = min(x, dlfb->damage_x);  in dlfb_offload_damage()
705 	dlfb->damage_x2 = max(x2, dlfb->damage_x2);  in dlfb_offload_damage()
706 	dlfb->damage_y = min(y, dlfb->damage_y);  in dlfb_offload_damage()
707 	dlfb->damage_y2 = max(y2, dlfb->damage_y2);  in dlfb_offload_damage()
708 	spin_unlock_irqrestore(&dlfb->damage_lock, flags);  in dlfb_offload_damage()
710 	schedule_work(&dlfb->damage_work);  in dlfb_offload_damage()
723 	struct dlfb_data *dlfb = info->par;  in dlfb_ops_write()  local
733 		dlfb_handle_damage(dlfb, 0, start, info->var.xres,  in dlfb_ops_write()
745 	struct dlfb_data *dlfb = info->par;  in dlfb_ops_copyarea()  local
749 	dlfb_offload_damage(dlfb, area->dx, area->dy,  in dlfb_ops_copyarea()
756 	struct dlfb_data *dlfb = info->par;  in dlfb_ops_imageblit()  local
760 	dlfb_offload_damage(dlfb, image->dx, image->dy,  in dlfb_ops_imageblit()
767 	struct dlfb_data *dlfb = info->par;  in dlfb_ops_fillrect()  local
771 	dlfb_offload_damage(dlfb, rect->dx, rect->dy, rect->width,  in dlfb_ops_fillrect()
786 	struct dlfb_data *dlfb = info->par;  in dlfb_dpy_deferred_io()  local
794 	mutex_lock(&dlfb->render_mutex);  in dlfb_dpy_deferred_io()
799 	if (!atomic_read(&dlfb->usb_active))  in dlfb_dpy_deferred_io()
804 	urb = dlfb_get_urb(dlfb);  in dlfb_dpy_deferred_io()
813 		if (dlfb_render_hline(dlfb, &urb, (char *) info->fix.smem_start,  in dlfb_dpy_deferred_io()
826 		dlfb_submit_urb(dlfb, urb, len);  in dlfb_dpy_deferred_io()
832 	atomic_add(bytes_sent, &dlfb->bytes_sent);  in dlfb_dpy_deferred_io()
833 	atomic_add(bytes_identical, &dlfb->bytes_identical);  in dlfb_dpy_deferred_io()
834 	atomic_add(bytes_rendered, &dlfb->bytes_rendered);  in dlfb_dpy_deferred_io()
838 		   &dlfb->cpu_kcycles_used);  in dlfb_dpy_deferred_io()
840 	mutex_unlock(&dlfb->render_mutex);  in dlfb_dpy_deferred_io()
843 static int dlfb_get_edid(struct dlfb_data *dlfb, char *edid, int len)  in dlfb_get_edid()  argument
853 		ret = usb_control_msg(dlfb->udev,  in dlfb_get_edid()
854 				      usb_rcvctrlpipe(dlfb->udev, 0), 0x02,  in dlfb_get_edid()
858 			dev_err(&dlfb->udev->dev,  in dlfb_get_edid()
875 	struct dlfb_data *dlfb = info->par;  in dlfb_ops_ioctl()  local
877 	if (!atomic_read(&dlfb->usb_active))  in dlfb_ops_ioctl()
883 		if (copy_to_user(edid, dlfb->edid, dlfb->edid_size))  in dlfb_ops_ioctl()
918 		dlfb_handle_damage(dlfb, area.x, area.y, area.w, area.h);  in dlfb_ops_ioctl()
958 	struct dlfb_data *dlfb = info->par;  in dlfb_ops_open()  local
969 	if (dlfb->virtualized)  in dlfb_ops_open()
972 	dlfb->fb_count++;  in dlfb_ops_open()
991 		user, info, dlfb->fb_count);  in dlfb_ops_open()
998 	struct dlfb_data *dlfb = info->par;  in dlfb_ops_destroy()  local
1000 	cancel_work_sync(&dlfb->damage_work);  in dlfb_ops_destroy()
1002 	mutex_destroy(&dlfb->render_mutex);  in dlfb_ops_destroy()
1012 	while (!list_empty(&dlfb->deferred_free)) {  in dlfb_ops_destroy()
1013 …struct dlfb_deferred_free *d = list_entry(dlfb->deferred_free.next, struct dlfb_deferred_free, lis…  in dlfb_ops_destroy()
1018 	vfree(dlfb->backing_buffer);  in dlfb_ops_destroy()
1019 	kfree(dlfb->edid);  in dlfb_ops_destroy()
1020 	usb_put_dev(dlfb->udev);  in dlfb_ops_destroy()
1021 	kfree(dlfb);  in dlfb_ops_destroy()
1032 	struct dlfb_data *dlfb = info->par;  in dlfb_ops_release()  local
1034 	dlfb->fb_count--;  in dlfb_ops_release()
1036 	if ((dlfb->fb_count == 0) && (info->fbdefio)) {  in dlfb_ops_release()
1042 	dev_dbg(info->dev, "release, user=%d count=%d\n", user, dlfb->fb_count);  in dlfb_ops_release()
1051 static int dlfb_is_valid_mode(struct fb_videomode *mode, struct dlfb_data *dlfb)  in dlfb_is_valid_mode()  argument
1053 	if (mode->xres * mode->yres > dlfb->sku_pixel_limit)  in dlfb_is_valid_mode()
1075 	struct dlfb_data *dlfb = info->par;  in dlfb_ops_check_var()  local
1082 	if (!dlfb_is_valid_mode(&mode, dlfb))  in dlfb_ops_check_var()
1090 	struct dlfb_data *dlfb = info->par;  in dlfb_ops_set_par()  local
1102 	if (!memcmp(&dlfb->current_mode, &fvs, sizeof(struct fb_var_screeninfo)))  in dlfb_ops_set_par()
1105 	result = dlfb_realloc_framebuffer(dlfb, info, info->var.yres * line_length);  in dlfb_ops_set_par()
1109 	result = dlfb_set_video_mode(dlfb, &info->var);  in dlfb_ops_set_par()
1114 	dlfb->current_mode = fvs;  in dlfb_ops_set_par()
1117 	if (dlfb->fb_count == 0) {  in dlfb_ops_set_par()
1126 	dlfb_handle_damage(dlfb, 0, 0, info->var.xres, info->var.yres);  in dlfb_ops_set_par()
1151 	struct dlfb_data *dlfb = info->par;  in dlfb_ops_blank()  local
1156 		dlfb->blank_mode, blank_mode);  in dlfb_ops_blank()
1158 	if ((dlfb->blank_mode == FB_BLANK_POWERDOWN) &&  in dlfb_ops_blank()
1162 		dlfb_set_video_mode(dlfb, &info->var);  in dlfb_ops_blank()
1165 	urb = dlfb_get_urb(dlfb);  in dlfb_ops_blank()
1177 	dlfb_submit_urb(dlfb, urb, bufptr -  in dlfb_ops_blank()
1180 	dlfb->blank_mode = blank_mode;  in dlfb_ops_blank()
1204 static void dlfb_deferred_vfree(struct dlfb_data *dlfb, void *mem)  in dlfb_deferred_vfree()  argument
1210 	list_add(&d->list, &dlfb->deferred_free);  in dlfb_deferred_vfree()
1217 static int dlfb_realloc_framebuffer(struct dlfb_data *dlfb, struct fb_info *info, u32 new_len)  in dlfb_realloc_framebuffer()  argument
1239 			dlfb_deferred_vfree(dlfb, (void __force *)info->screen_base);  in dlfb_realloc_framebuffer()
1259 			dlfb_deferred_vfree(dlfb, dlfb->backing_buffer);  in dlfb_realloc_framebuffer()
1260 			dlfb->backing_buffer = new_back;  in dlfb_realloc_framebuffer()
1280 static int dlfb_setup_modes(struct dlfb_data *dlfb,  in dlfb_setup_modes()  argument
1313 		i = dlfb_get_edid(dlfb, edid, EDID_LENGTH);  in dlfb_setup_modes()
1319 			dlfb->edid = edid;  in dlfb_setup_modes()
1320 			dlfb->edid_size = i;  in dlfb_setup_modes()
1329 		if (dlfb->edid) {  in dlfb_setup_modes()
1330 			fb_edid_to_monspecs(dlfb->edid, &info->monspecs);  in dlfb_setup_modes()
1342 				dlfb->edid = edid;  in dlfb_setup_modes()
1343 				dlfb->edid_size = default_edid_size;  in dlfb_setup_modes()
1354 			if (dlfb_is_valid_mode(mode, dlfb)) {  in dlfb_setup_modes()
1383 			if (dlfb_is_valid_mode(mode, dlfb))  in dlfb_setup_modes()
1402 	if ((default_vmode != NULL) && (dlfb->fb_count == 0)) {  in dlfb_setup_modes()
1415 	if (edid && (dlfb->edid != edid))  in dlfb_setup_modes()
1427 	struct dlfb_data *dlfb = fb_info->par;  in metrics_bytes_rendered_show()  local
1429 			atomic_read(&dlfb->bytes_rendered));  in metrics_bytes_rendered_show()
1435 	struct dlfb_data *dlfb = fb_info->par;  in metrics_bytes_identical_show()  local
1437 			atomic_read(&dlfb->bytes_identical));  in metrics_bytes_identical_show()
1443 	struct dlfb_data *dlfb = fb_info->par;  in metrics_bytes_sent_show()  local
1445 			atomic_read(&dlfb->bytes_sent));  in metrics_bytes_sent_show()
1451 	struct dlfb_data *dlfb = fb_info->par;  in metrics_cpu_kcycles_used_show()  local
1453 			atomic_read(&dlfb->cpu_kcycles_used));  in metrics_cpu_kcycles_used_show()
1462 	struct dlfb_data *dlfb = fb_info->par;  in edid_show()  local
1464 	if (dlfb->edid == NULL)  in edid_show()
1467 	if ((off >= dlfb->edid_size) || (count > dlfb->edid_size))  in edid_show()
1470 	if (off + count > dlfb->edid_size)  in edid_show()
1471 		count = dlfb->edid_size - off;  in edid_show()
1473 	memcpy(buf, dlfb->edid, count);  in edid_show()
1484 	struct dlfb_data *dlfb = fb_info->par;  in edid_store()  local
1491 	ret = dlfb_setup_modes(dlfb, fb_info, src, src_size);  in edid_store()
1495 	if (!dlfb->edid || memcmp(src, dlfb->edid, src_size))  in edid_store()
1510 	struct dlfb_data *dlfb = fb_info->par;  in metrics_reset_store()  local
1512 	atomic_set(&dlfb->bytes_rendered, 0);  in metrics_reset_store()
1513 	atomic_set(&dlfb->bytes_identical, 0);  in metrics_reset_store()
1514 	atomic_set(&dlfb->bytes_sent, 0);  in metrics_reset_store()
1515 	atomic_set(&dlfb->cpu_kcycles_used, 0);  in metrics_reset_store()
1539 static int dlfb_select_std_channel(struct dlfb_data *dlfb)  in dlfb_select_std_channel()  argument
1554 	ret = usb_control_msg(dlfb->udev, usb_sndctrlpipe(dlfb->udev, 0),  in dlfb_select_std_channel()
1564 static int dlfb_parse_vendor_descriptor(struct dlfb_data *dlfb,  in dlfb_parse_vendor_descriptor()  argument
1620 				dlfb->sku_pixel_limit = max_area;  in dlfb_parse_vendor_descriptor()
1649 	struct dlfb_data *dlfb;  in dlfb_usb_probe()  local
1655 	dlfb = kzalloc(sizeof(*dlfb), GFP_KERNEL);  in dlfb_usb_probe()
1656 	if (!dlfb) {  in dlfb_usb_probe()
1661 	INIT_LIST_HEAD(&dlfb->deferred_free);  in dlfb_usb_probe()
1663 	dlfb->udev = usb_get_dev(usbdev);  in dlfb_usb_probe()
1664 	usb_set_intfdata(intf, dlfb);  in dlfb_usb_probe()
1670 	dlfb->sku_pixel_limit = 2048 * 1152; /* default to maximum */  in dlfb_usb_probe()
1672 	if (!dlfb_parse_vendor_descriptor(dlfb, intf)) {  in dlfb_usb_probe()
1681 			 dlfb->sku_pixel_limit, pixel_limit);  in dlfb_usb_probe()
1682 		dlfb->sku_pixel_limit = pixel_limit;  in dlfb_usb_probe()
1687 	info = framebuffer_alloc(0, &dlfb->udev->dev);  in dlfb_usb_probe()
1691 	dlfb->info = info;  in dlfb_usb_probe()
1692 	info->par = dlfb;  in dlfb_usb_probe()
1693 	info->pseudo_palette = dlfb->pseudo_palette;  in dlfb_usb_probe()
1694 	dlfb->ops = dlfb_ops;  in dlfb_usb_probe()
1695 	info->fbops = &dlfb->ops;  in dlfb_usb_probe()
1697 	mutex_init(&dlfb->render_mutex);  in dlfb_usb_probe()
1698 	dlfb_init_damage(dlfb);  in dlfb_usb_probe()
1699 	spin_lock_init(&dlfb->damage_lock);  in dlfb_usb_probe()
1700 	INIT_WORK(&dlfb->damage_work, dlfb_damage_work);  in dlfb_usb_probe()
1704 	if (!dlfb_alloc_urb_list(dlfb, WRITES_IN_FLIGHT, MAX_TRANSFER)) {  in dlfb_usb_probe()
1718 	retval = dlfb_setup_modes(dlfb, info, NULL, 0);  in dlfb_usb_probe()
1727 	atomic_set(&dlfb->usb_active, 1);  in dlfb_usb_probe()
1728 	dlfb_select_std_channel(dlfb);  in dlfb_usb_probe()
1759 		 ((dlfb->backing_buffer) ?  in dlfb_usb_probe()
1764 	if (dlfb->info) {  in dlfb_usb_probe()
1765 		dlfb_ops_destroy(dlfb->info);  in dlfb_usb_probe()
1767 		usb_put_dev(dlfb->udev);  in dlfb_usb_probe()
1768 		kfree(dlfb);  in dlfb_usb_probe()
1775 	struct dlfb_data *dlfb;  in dlfb_usb_disconnect()  local
1779 	dlfb = usb_get_intfdata(intf);  in dlfb_usb_disconnect()
1780 	info = dlfb->info;  in dlfb_usb_disconnect()
1785 	dlfb->virtualized = true;  in dlfb_usb_disconnect()
1788 	atomic_set(&dlfb->usb_active, 0);  in dlfb_usb_disconnect()
1791 	dlfb_free_urb_list(dlfb);  in dlfb_usb_disconnect()
1813 	struct dlfb_data *dlfb = unode->dlfb;  in dlfb_urb_completion()  local
1826 		dev_err(&dlfb->udev->dev,  in dlfb_urb_completion()
1829 		atomic_set(&dlfb->lost_pixels, 1);  in dlfb_urb_completion()
1833 	urb->transfer_buffer_length = dlfb->urbs.size; /* reset to actual */  in dlfb_urb_completion()
1835 	spin_lock_irqsave(&dlfb->urbs.lock, flags);  in dlfb_urb_completion()
1836 	list_add_tail(&unode->entry, &dlfb->urbs.list);  in dlfb_urb_completion()
1837 	dlfb->urbs.available++;  in dlfb_urb_completion()
1838 	spin_unlock_irqrestore(&dlfb->urbs.lock, flags);  in dlfb_urb_completion()
1840 	up(&dlfb->urbs.limit_sem);  in dlfb_urb_completion()
1843 static void dlfb_free_urb_list(struct dlfb_data *dlfb)  in dlfb_free_urb_list()  argument
1845 	int count = dlfb->urbs.count;  in dlfb_free_urb_list()
1852 		down(&dlfb->urbs.limit_sem);  in dlfb_free_urb_list()
1854 		spin_lock_irq(&dlfb->urbs.lock);  in dlfb_free_urb_list()
1856 		node = dlfb->urbs.list.next; /* have reserved one with sem */  in dlfb_free_urb_list()
1859 		spin_unlock_irq(&dlfb->urbs.lock);  in dlfb_free_urb_list()
1865 		usb_free_coherent(urb->dev, dlfb->urbs.size,  in dlfb_free_urb_list()
1871 	dlfb->urbs.count = 0;  in dlfb_free_urb_list()
1874 static int dlfb_alloc_urb_list(struct dlfb_data *dlfb, int count, size_t size)  in dlfb_alloc_urb_list()  argument
1881 	spin_lock_init(&dlfb->urbs.lock);  in dlfb_alloc_urb_list()
1884 	dlfb->urbs.size = size;  in dlfb_alloc_urb_list()
1885 	INIT_LIST_HEAD(&dlfb->urbs.list);  in dlfb_alloc_urb_list()
1887 	sema_init(&dlfb->urbs.limit_sem, 0);  in dlfb_alloc_urb_list()
1888 	dlfb->urbs.count = 0;  in dlfb_alloc_urb_list()
1889 	dlfb->urbs.available = 0;  in dlfb_alloc_urb_list()
1891 	while (dlfb->urbs.count * size < wanted_size) {  in dlfb_alloc_urb_list()
1895 		unode->dlfb = dlfb;  in dlfb_alloc_urb_list()
1904 		buf = usb_alloc_coherent(dlfb->udev, size, GFP_KERNEL,  in dlfb_alloc_urb_list()
1911 				dlfb_free_urb_list(dlfb);  in dlfb_alloc_urb_list()
1918 		usb_fill_bulk_urb(urb, dlfb->udev, usb_sndbulkpipe(dlfb->udev, 1),  in dlfb_alloc_urb_list()
1922 		list_add_tail(&unode->entry, &dlfb->urbs.list);  in dlfb_alloc_urb_list()
1924 		up(&dlfb->urbs.limit_sem);  in dlfb_alloc_urb_list()
1925 		dlfb->urbs.count++;  in dlfb_alloc_urb_list()
1926 		dlfb->urbs.available++;  in dlfb_alloc_urb_list()
1929 	return dlfb->urbs.count;  in dlfb_alloc_urb_list()
1932 static struct urb *dlfb_get_urb(struct dlfb_data *dlfb)  in dlfb_get_urb()  argument
1939 	ret = down_timeout(&dlfb->urbs.limit_sem, GET_URB_TIMEOUT);  in dlfb_get_urb()
1941 		atomic_set(&dlfb->lost_pixels, 1);  in dlfb_get_urb()
1942 		dev_warn(&dlfb->udev->dev,  in dlfb_get_urb()
1944 			 ret, dlfb->urbs.available);  in dlfb_get_urb()
1948 	spin_lock_irq(&dlfb->urbs.lock);  in dlfb_get_urb()
1950 	BUG_ON(list_empty(&dlfb->urbs.list)); /* reserved one with limit_sem */  in dlfb_get_urb()
1951 	entry = dlfb->urbs.list.next;  in dlfb_get_urb()
1953 	dlfb->urbs.available--;  in dlfb_get_urb()
1955 	spin_unlock_irq(&dlfb->urbs.lock);  in dlfb_get_urb()
1961 static int dlfb_submit_urb(struct dlfb_data *dlfb, struct urb *urb, size_t len)  in dlfb_submit_urb()  argument
1965 	BUG_ON(len > dlfb->urbs.size);  in dlfb_submit_urb()
1971 		atomic_set(&dlfb->lost_pixels, 1);  in dlfb_submit_urb()
1972 		dev_err(&dlfb->udev->dev, "submit urb error: %d\n", ret);  in dlfb_submit_urb()