1 files changed, 154 insertions, 0 deletions
diff --git a/fbcommon.inc b/fbcommon.inc
new file mode 100644
index 0000000..edcf749
--- /dev/null
+++ b/fbcommon.inc
@@ -0,0 +1,154 @@
+/* n is in bytes. dest must begin on pixel boundary. If n is not a whole number
+ * of pixels, rounding is performed downwards.
+ * if bmpixelsize is 1, no alignment is required.
+ * if bmpixelsize is 2, dest must be aligned to 2 bytes.
+ * if bmpixelsize is 3, no alignment is required.
+ * if bmpixelsize is 4, dest must be aligned to 4 bytes.
+ * -- The following do not occur, this is only for forward compatibility.
+ * if bmpixelsize is 5, no alignment is required.
+ * if bmpixelsize is 6, dest must be aligned to 2 bytes.
+ * if bmpixelsize is 7, no alignment is required.
+ * if bmpixelsize is 8, dest must be aligned to 8 bytes.
+ */
+
+static inline void pixel_set(unsigned char *dest, int n,void * pattern)
+{
+	switch(fb_pixelsize)
+	{
+		case 1:
+		memset(dest,*(unsigned char *)pattern,n);
+		break;
+
+		case 2:
+		{
+#ifdef t2c
+			t2c v=*(t2c *)do_not_optimize_here(pattern);
+#ifdef __ICC
+			volatile	/* ICC has an optimization bug here */
+#endif
+			int a;
+
+			if ((v & 255) == ((v >> 8) & 255)) {
+				memset(dest, v, n);
+			} else {
+#ifdef t8c
+				t8c vvvv=((t8c)v << 48) | ((t8c)v << 32) | ((t8c)v << 16) | v;
+#elif defined(t4c)
+				t4c vv=((t4c)v << 16) | v;
+#endif
+				a = n >> 1;
+				while (a) {
+#ifdef t8c
+					if (!((unsigned long)dest & 7) && a >= 4) {
+						do {
+							*((t8c *)dest) = vvvv;
+							dest += 8;
+							a -= 4;
+						} while (a >= 4);
+					} else
+#elif defined(t4c)
+					if (!((unsigned long)dest & 3) && a >= 2) {
+						do {
+							*((t4c *)dest) = vv;
+							dest += 4;
+							a -= 2;
+						} while (a >= 2);
+					} else
+#endif
+					{
+						*((t2c *)dest) = v;
+						dest += 2;
+						a--;
+					}
+				}
+			}
+#else
+			unsigned char a,b;
+			int i;
+
+			a=*(unsigned char*)pattern;
+			b=((unsigned char*)pattern)[1];
+			if (a == b) memset(dest, a, n);
+			else for (i=0;i<=n-2;i+=2){
+				dest[i]=a;
+				dest[i+1]=b;
+			}
+#endif
+		}
+		break;
+
+		case 3:
+		{
+			unsigned char a,b,c;
+			int i;
+
+			a=*(unsigned char*)pattern;
+			b=((unsigned char*)pattern)[1];
+			c=((unsigned char*)pattern)[2];
+			if (a == b && b == c) memset(dest, a, n);
+			else for (i=0;i<=n-3;i+=3){
+				dest[i]=a;
+				dest[i+1]=b;
+				dest[i+2]=c;
+			}
+		}
+		break;
+
+		case 4:
+		{
+#ifdef t4c
+			t4c v=*(t4c *)do_not_optimize_here(pattern);
+#ifdef __ICC
+			volatile	/* ICC has an optimization bug here */
+#endif
+			int a;
+
+			{
+#ifdef t8c
+				t8c vv = ((t8c)v << 32) | v;
+#endif
+				a = n >> 2;
+				while (a) {
+#ifdef t8c
+					if (!((unsigned long)dest & 7) && a >= 2) {
+						do {
+							*((t8c *)dest) = vv;
+							dest += 8;
+							a -= 2;
+						} while (a >= 2);
+					} else
+#endif
+					{
+						*(t4c *)dest = v;
+						dest += 4;
+						a--;
+					}
+				}
+			}
+#else
+			unsigned char a,b,c,d;
+			int i;
+
+			a=*(unsigned char*)pattern;
+			b=((unsigned char*)pattern)[1];
+			c=((unsigned char*)pattern)[2];
+			d=((unsigned char*)pattern)[3];
+			for (i=0;i<=n-4;i+=4){
+				dest[i]=a;
+				dest[i+1]=b;
+				dest[i+2]=c;
+				dest[i+3]=d;
+			}
+#endif
+		}
+		break;
+
+		default:
+		{
+			int a;
+			for (a=0;a<n/fb_pixelsize;a++,dest+=fb_pixelsize) memcpy(dest,pattern,fb_pixelsize);
+		}
+		break;
+	}
+}
+