2 files changed, 214 insertions, 96 deletions

diff --git a/target/linux/xburst/files-2.6.32/drivers/video/metronomefb.c b/target/linux/xburst/files-2.6.32/drivers/video/metronomefb.c
index 0d6a1cf4d..390d26e0d 100644
--- a/target/linux/xburst/files-2.6.32/drivers/video/metronomefb.c
+++ b/target/linux/xburst/files-2.6.32/drivers/video/metronomefb.c
@@ -19,8 +19,6 @@
  *
  */
 
-#define DEBUG
-
 #include <linux/module.h>
 #include <linux/kernel.h>
 #include <linux/errno.h>
@@ -44,10 +42,6 @@
 
 #include <asm/unaligned.h>
 
-/* Display specific information */
-#define DPY_W 832
-#define DPY_H 622
-
 #define WF_MODE_INIT	0 /* Initialization */
 #define WF_MODE_MU	1 /* Monochrome update */
 #define WF_MODE_GU	2 /* Grayscale update */
@@ -63,7 +57,7 @@ struct epd_frame {
 	int wfm_size;
 };
 
-static struct epd_frame epd_frame_table[] = {
+static const struct epd_frame epd_frame_table[] = {
 	{
 		.fw = 832,
 		.fh = 622,
@@ -130,22 +124,17 @@ static struct epd_frame epd_frame_table[] = {
 	},
 };
 
-static const struct fb_fix_screeninfo metronomefb_fix __devinitdata = {
+static const struct fb_fix_screeninfo metronomefb_fix __devinitconst = {
 	.id =		"metronomefb",
 	.type =		FB_TYPE_PACKED_PIXELS,
 	.visual =	FB_VISUAL_STATIC_PSEUDOCOLOR,
 	.xpanstep =	0,
 	.ypanstep =	0,
 	.ywrapstep =	0,
-	.line_length =	DPY_W,
 	.accel =	FB_ACCEL_NONE,
 };
 
-static const struct fb_var_screeninfo metronomefb_var __devinitdata = {
-	.xres		= DPY_W,
-	.yres		= DPY_H,
-	.xres_virtual	= DPY_W,
-	.yres_virtual	= DPY_H,
+static const struct fb_var_screeninfo metronomefb_var __devinitconst = {
 	.bits_per_pixel	= 8,
 	.grayscale	= 1,
 	.nonstd		= 1,
@@ -365,7 +354,6 @@ static int metronome_display_cmd(struct metronomefb_par *par)
 	int i;
 	u16 cs;
 	u16 opcode;
-	static u8 borderval;
 	int res;
 
 	res = wait_for_rdy(par);
@@ -442,8 +430,8 @@ static int __devinit metronome_config_cmd(struct metronomefb_par *par)
 	will try parse the command before we've set it all up */
 
 	dev_dbg(&par->pdev->dev, "%s: ENTER\n", __func__);
-	memcpy(par->metromem_cmd->args, epd_frame_table[par->dt].config,
-		sizeof(epd_frame_table[par->dt].config));
+	memcpy(par->metromem_cmd->args, par->epd_frame->config,
+		sizeof(par->epd_frame->config));
 	/* the rest are 0 */
 	memset((u8 *) (par->metromem_cmd->args + 4), 0, (32-4)*2);
 
@@ -520,35 +508,102 @@ static int __devinit metronome_init_regs(struct metronomefb_par *par)
 	return res;
 }
 
-static void metronomefb_dpy_update(struct metronomefb_par *par, int clear_all)
+static uint16_t metronomefb_update_img_buffer_rotated(struct metronomefb_par *par)
 {
 	int x, y;
-	int i;
-	u16 cksum = 0;
-	u32 *buf = (u32 __force *)par->info->screen_base;
-	u32 *img = (u32 *)(par->metromem_img);
-	u32 diff;
-	u32 tmp;
-	unsigned int fbsize = par->info->fix.smem_len;
-	int fx = par->info->fix.line_length;
-	int fy = fbsize / fx;
-	int fx_buf = fx / sizeof(*buf);
-	int m;
-	static int is_first_update = 1;
-	static int partial_updates_count = 0;
-	u32 *fxbuckets = par->fxbuckets;
-	u32 *fybuckets = par->fybuckets;
+	int xstep, ystep;
+	int i, j;
+	uint16_t cksum = 0;
+	uint8_t *buf = par->info->screen_base;
+	uint32_t *img = (uint32_t *)(par->metromem_img);
+	int fw = par->epd_frame->fw;
+	int fh = par->epd_frame->fh;
+	int fw_buf = fw / 4;
+	uint32_t *fxbuckets = par->fxbuckets;
+	uint32_t *fybuckets = par->fybuckets;
+	uint32_t diff;
+	uint32_t tmp;
+
+	switch (par->info->var.rotate) {
+	case FB_ROTATE_CW:
+		xstep = -fh;
+		ystep = fw * fh + 1;
+		j = (fw - 1) * fh;
+		break;
+	case FB_ROTATE_UD:
+		xstep = -1;
+		ystep = 0;
+		j = fw * fh - 1;
+		break;
+	case FB_ROTATE_CCW:
+		xstep = fh;
+		ystep = -fw * fh - 1;
+		j = fh - 1;
+		break;
+	default:
+		BUG();
+		break;
+	}
 
-	wait_for_rdy(par);
+	memset(fxbuckets, 0, fw_buf * sizeof(*fxbuckets));
+	memset(fybuckets, 0, fh * sizeof(*fybuckets));
+
+	i = 0;
+	for (y = 0; y < fh; y++) {
+		for(x = 0; x < fw_buf; x++, i++) {
+			if (j < 0 || j >= fw * fh) {
+				printk("moo: %d %d %d %d %d\n", j, x, y, fw_buf, fh);
+				return 0;
+			}
+			tmp = (buf[j] << 5);
+			j += xstep;
+			tmp |= (buf[j] << 13);
+			j += xstep;
+			tmp |= (buf[j] << 21);
+			j += xstep;
+			tmp |= (buf[j] << 29);
+			j += xstep;
+			tmp &= 0xe0e0e0e0;
+
+			img[i] &= 0xf0f0f0f0;
+			diff = img[i] ^ tmp;
+
+			fxbuckets[x] |= diff;
+			fybuckets[y] |= diff;
+
+			img[i] = (img[i] >> 4) | tmp;
+			cksum += img[i] & 0x0000ffff;
+			cksum += (img[i] >> 16);
 
-	memset(fxbuckets, 0, fx_buf * sizeof(*fxbuckets));
-	memset(fybuckets, 0, fy * sizeof(*fybuckets));
+		}
+		j += ystep;
+	}
+
+	return cksum;
+}
+
+static uint16_t metronomefb_update_img_buffer_normal(struct metronomefb_par *par)
+{
+	int x, y, i;
+	uint16_t cksum = 0;
+	uint32_t *buf = (uint32_t __force *)par->info->screen_base;
+	uint32_t *img = (uint32_t *)(par->metromem_img);
+	uint32_t diff;
+	uint32_t tmp;
+	int fw = par->epd_frame->fw;
+	int fh = par->epd_frame->fh;
+	int fw_buf = fw / sizeof(*buf);
+	uint32_t *fxbuckets = par->fxbuckets;
+	uint32_t *fybuckets = par->fybuckets;
+
+	memset(fxbuckets, 0, fw_buf * sizeof(*fxbuckets));
+	memset(fybuckets, 0, fh * sizeof(*fybuckets));
 
 	i = 0;
-	for (y = 0; y < fy; y++) {
-		for(x = 0; x < fx_buf; x++, i++) {
-			tmp = (buf[i] << 5) & 0xE0E0E0E0;
-			img[i] &= 0xF0F0F0F0;
+	for (y = 0; y < fh; y++) {
+		for(x = 0; x < fw_buf; x++, i++) {
+			tmp = (buf[i] << 5) & 0xe0e0e0e0;
+			img[i] &= 0xf0f0f0f0;
 			diff = img[i] ^ tmp;
 
 			fxbuckets[x] |= diff;
@@ -560,73 +615,92 @@ static void metronomefb_dpy_update(struct metronomefb_par *par, int clear_all)
 		}
 	}
 
-	*((u16 *)(par->metromem_img) + fbsize/2) = cksum;
+	return cksum;
+}
 
-	if (clear_all || is_first_update ||
-		(partial_updates_count == par->partial_autorefresh_interval)) {
-		m = WF_MODE_GC;
-		partial_updates_count = 0;
-	} else {
-		int min_x = fx_buf;
-		int max_x = 0;
-		int min_y = fy;
-		int max_y = 0;
-		int change_count;
-
-		for (x = 0; x < fx_buf; x++)
-			if(fxbuckets[x]) {
-				min_x = x;
-				break;
-			}
+static unsigned int metronomefb_get_change_count(struct metronomefb_par *par)
+{
+	int min_x;
+	int max_x;
+	int min_y;
+	int max_y;
+	int fw = par->epd_frame->fw / 4;
+	int fh = par->epd_frame->fh;
+	unsigned int change_count;
+	uint32_t *fxbuckets = par->fxbuckets;
+	uint32_t *fybuckets = par->fybuckets;
+
+	for (min_x = 0; min_x < fw; ++min_x) {
+		if(fxbuckets[min_x])
+			break;
+	}
 
-		for (x = fx_buf - 1; x >= 0; x--)
-			if(fxbuckets[x]) {
-				max_x = x;
-				break;
-			}
+	for (max_x = fw - 1; max_x >= 0; --max_x) {
+		if(fxbuckets[max_x])
+			break;
+	}
 
-		for (y = 0; y < fy; y++)
-			if(fybuckets[y]) {
-				min_y = y;
-				break;
-			}
+	for (min_y = 0; min_y < fh; min_y++) {
+		if(fybuckets[min_y])
+			break;
+	}
 
-		for (y = fy - 1; y >= 0; y--)
-			if(fybuckets[y]) {
-				max_y = y;
-				break;
-			}
+	for (max_y = fh - 1; max_y >= 0; --max_y) {
+		if(fybuckets[max_y])
+			break;
+	}
 
-		if ((min_x > max_x) || (min_y > max_y))
-			change_count = 0;
-		else
-			change_count = (max_x - min_x + 1) * (max_y - min_y + 1) * sizeof(*buf);
+	if ((min_x > max_x) || (min_y > max_y))
+		change_count = 0;
+	else
+		change_count = (max_x - min_x + 1) * (max_y - min_y + 1) * 4;
 
+	dev_dbg(&par->pdev->dev, "min_x = %d, max_x = %d, min_y = %d, max_y = %d\n",
+			min_x, max_x, min_y, max_y);
+
+	return change_count;
+}
+
+static void metronomefb_dpy_update(struct metronomefb_par *par, int clear_all)
+{
+	unsigned int fbsize = par->info->fix.smem_len;
+	uint16_t cksum;
+	int m;
+
+	wait_for_rdy(par);
+
+	if (par->info->var.rotate == 0)
+		cksum = metronomefb_update_img_buffer_normal(par);
+	else
+		cksum = metronomefb_update_img_buffer_rotated(par);
+
+	*par->metromem_img_csum = __cpu_to_le16(cksum);
+
+	if (clear_all || par->is_first_update ||
+		(par->partial_updates_count == par->partial_autorefresh_interval)) {
+		m = WF_MODE_GC;
+		par->partial_updates_count = 0;
+	} else {
+		int change_count = metronomefb_get_change_count(par);
 		if (change_count < fbsize / 100 * par->manual_refresh_threshold)
 			m = WF_MODE_GU;
 		else
 			m = WF_MODE_GC;
 
-		dev_dbg(&par->pdev->dev, "min_x = %d, max_x = %d, min_y = %d, max_y = %d\n",
-				min_x, max_x, min_y, max_y);
 		dev_dbg(&par->pdev->dev, "change_count = %u, treshold = %u%% (%u pixels)\n",
 				change_count, par->manual_refresh_threshold,
 				fbsize / 100 * par->manual_refresh_threshold);
-
-		partial_updates_count++;
+		++par->partial_updates_count;
 	}
 
-	if (m != par->current_wf_mode) {
+	if (m != par->current_wf_mode)
 		load_waveform((u8 *) par->firmware->data, par->firmware->size,
 				m, par->current_wf_temp, par);
-	}
-
-	for(;;) {
-		if (likely(!check_err(par))) {
-			metronome_display_cmd(par);
-			break;
-		}
 
+again:
+	metronome_display_cmd(par);
+	wait_for_rdy(par);
+	if (unlikely(check_err(par))) {
 		par->board->set_stdby(par, 0);
 		printk("Resetting Metronome\n");
 		par->board->set_rst(par, 0);
@@ -637,12 +711,15 @@ static void metronomefb_dpy_update(struct metronomefb_par *par, int clear_all)
 		mdelay(1);
 		load_waveform((u8 *) par->firmware->data, par->firmware->size,
 				WF_MODE_GC, par->current_wf_temp, par);
+
 		if (par->board->power_ctl)
 			par->board->power_ctl(par, METRONOME_POWER_ON);
 		metronome_bootup(par);
+
+		goto again;
 	}
 
-	is_first_update = 0;
+	par->is_first_update = 0;
 }
 
 /* this is called back from the deferred io workqueue */
@@ -742,12 +819,46 @@ static ssize_t metronomefb_write(struct fb_info *info, const char __user *buf,
 	return (err) ? err : count;
 }
 
+static int metronome_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
+{
+	struct metronomefb_par *par = info->par;
+
+	if (par->epd_frame->fw == var->xres && par->epd_frame->fh == var->yres)
+		return 0;
+
+	return -EINVAL;
+}
+
+static int metronomefb_set_par(struct fb_info *info)
+{
+	struct metronomefb_par *par = info->par;
+
+	switch (info->var.rotate) {
+	case FB_ROTATE_CW:
+	case FB_ROTATE_CCW:
+		info->fix.line_length = info->var.yres;
+		break;
+	case FB_ROTATE_UD:
+	default:
+		info->fix.line_length = info->var.xres;
+		break;
+	}
+
+	mutex_lock(&par->lock);
+	metronomefb_dpy_update(info->par, 1);
+	mutex_unlock(&par->lock);
+
+	return 0;
+}
+
 static struct fb_ops metronomefb_ops = {
 	.owner		= THIS_MODULE,
 	.fb_write	= metronomefb_write,
 	.fb_fillrect	= metronomefb_fillrect,
 	.fb_copyarea	= metronomefb_copyarea,
 	.fb_imageblit	= metronomefb_imageblit,
+	.fb_check_var	= metronome_check_var,
+	.fb_set_par	= metronomefb_set_par,
 };
 
 static struct fb_deferred_io metronomefb_defio = {
@@ -979,15 +1090,13 @@ static int __devinit metronomefb_probe(struct platform_device *dev)
 	info->var.yres = fh;
 	info->var.xres_virtual = fw;
 	info->var.yres_virtual = fh;
-
 	info->fix = metronomefb_fix;
-	info->fix.smem_len = fw * fh; /* Real size of image area */
 	info->fix.line_length = fw;
-
+	info->fix.smem_len = fw * fh; /* Real size of image area */
 	par = info->par;
 	par->info = info;
 	par->board = board;
-	par->dt = epd_dt_index;
+	par->epd_frame = &epd_frame_table[epd_dt_index];
 	par->pdev = dev;
 
 	par->fxbuckets = kmalloc((fw / 4 + 1) * sizeof(*par->fxbuckets), GFP_KERNEL);
@@ -1001,6 +1110,8 @@ static int __devinit metronomefb_probe(struct platform_device *dev)
 	init_waitqueue_head(&par->waitq);
 	par->manual_refresh_threshold = 60;
 	par->partial_autorefresh_interval = 256;
+	par->partial_updates_count = 0;
+	par->is_first_update = 1;
 	mutex_init(&par->lock);
 
 	/* this table caches per page csum values. */
@@ -1025,7 +1136,7 @@ static int __devinit metronomefb_probe(struct platform_device *dev)
 		goto err_csum_table;
 	}
 
-	info->fix.smem_start = 0;
+	info->fix.smem_start = par->metromem_dma;
 
 	/* load the waveform in. assume mode 3, temp 31 for now
 		a) request the waveform file from userspace
@@ -1173,6 +1284,7 @@ static int metronomefb_suspend(struct platform_device *pdev, pm_message_t messag
 	if (par->board->power_ctl)
 		par->board->power_ctl(par, METRONOME_POWER_OFF);
 
+
 	return 0;
 }
 
diff --git a/target/linux/xburst/files-2.6.32/include/video/metronomefb.h b/target/linux/xburst/files-2.6.32/include/video/metronomefb.h
index 8c7bdbec7..ea446ae85 100644
--- a/target/linux/xburst/files-2.6.32/include/video/metronomefb.h
+++ b/target/linux/xburst/files-2.6.32/include/video/metronomefb.h
@@ -17,7 +17,9 @@ struct metromem_cmd {
 	u16 opcode;
 	u16 args[((64-2)/2)];
 	u16 csum;
-} __attribute__(packed);
+} __attribute__((packed));
+
+struct epd_frame;
 
 /* struct used by metronome. board specific stuff comes from *board */
 struct metronomefb_par {
@@ -38,9 +40,13 @@ struct metronomefb_par {
 	int current_wf_temp;
 	unsigned int manual_refresh_threshold;
 	unsigned int partial_autorefresh_interval;
-	int dt;
+	const struct epd_frame *epd_frame;
 	u32 *fxbuckets;
 	u32 *fybuckets;
+
+	unsigned int partial_updates_count;
+	unsigned is_first_update:1;
+
 	struct mutex lock;
 };