X-Git-Url: https://notaz.gp2x.de/cgi-bin/gitweb.cgi?a=blobdiff_plain;f=pandora%2Fpicorestore.c;h=77f572020b7465ddc4e905bff1fbe7d963f18e8d;hb=4db02226eb3c80f49f5c412f7718c437c5e817fc;hp=6a327552a458ff6edbf0998c824440a36594674b;hpb=f6eaae4f09c6abab99692900a31c1df2a06b99af;p=libpicofe.git

diff --git a/pandora/picorestore.c b/pandora/picorestore.c
index 6a32755..77f5720 100644
--- a/pandora/picorestore.c
+++ b/pandora/picorestore.c
@@ -1,3 +1,31 @@
+/*
+ * picorestore - clean up after an omapfb program crash
+ *
+ * Copyright (c) Gražvydas "notaz" Ignotas, 2010
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *     * Redistributions of source code must retain the above copyright
+ *       notice, this list of conditions and the following disclaimer.
+ *     * Redistributions in binary form must reproduce the above copyright
+ *       notice, this list of conditions and the following disclaimer in the
+ *       documentation and/or other materials provided with the distribution.
+ *     * Neither the name of the organization nor the
+ *       names of its contributors may be used to endorse or promote products
+ *       derived from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
 #include <stdio.h>
 #include <sys/types.h>
 #include <sys/stat.h>
@@ -5,26 +33,26 @@
 #include <unistd.h>
 #include <sys/ioctl.h>
 #include <linux/fb.h>
-#include <termios.h>
+#include <linux/omapfb.h>
 #include <linux/kd.h>
 
 int main()
 {
 	struct fb_var_screeninfo fbvar;
-	struct termios kbd_termios;
+	struct omapfb_plane_info pi;
+	struct omapfb_mem_info mi;
 	int ret, fbdev, kbdfd;
-	FILE *tios_f;
 
 	fbdev = open("/dev/fb0", O_RDWR);
 	if (fbdev == -1) {
-		perror("open");
-		return 1;
+		perror("open fb0");
+		goto end_fb0;
 	}
 
 	ret = ioctl(fbdev, FBIOGET_VSCREENINFO, &fbvar);
 	if (ret == -1) {
 		perror("FBIOGET_VSCREENINFO ioctl");
-		goto end_fb;
+		goto end_fb0;
 	}
 
 	if (fbvar.yoffset != 0) {
@@ -37,31 +65,45 @@ int main()
 			printf("ok\n");
 	}
 
-end_fb:
-	close(fbdev);
+end_fb0:
+	if (fbdev >= 0)
+		close(fbdev);
+
+	fbdev = open("/dev/fb1", O_RDWR);
+	if (fbdev == -1) {
+		perror("open fb1");
+		goto end_fb1;
+	}
 
-	tios_f = fopen("/tmp/pico_tios", "rb");
-	if (tios_f != NULL) {
-		kbdfd = open("/dev/tty", O_RDWR);
-		if (kbdfd == -1) {
-			perror("open /dev/tty");
-			return 1;
-		}
+	ret  = ioctl(fbdev, OMAPFB_QUERY_PLANE, &pi);
+	ret |= ioctl(fbdev, OMAPFB_QUERY_MEM, &mi);
+	if (ret != 0)
+		perror("QUERY_*");
 
-		if (fread(&kbd_termios, sizeof(kbd_termios), 1, tios_f) == 1) {
-			if (ioctl(kbdfd, KDSETMODE, KD_TEXT) == -1)
-				perror("KDSETMODE KD_TEXT");
+	pi.enabled = 0;
+	ret = ioctl(fbdev, OMAPFB_SETUP_PLANE, &pi);
+	if (ret != 0)
+		perror("SETUP_PLANE");
 
-			printf("restoring termios.. ");
-			if (tcsetattr(kbdfd, TCSAFLUSH, &kbd_termios) == -1)
-				perror("tcsetattr");
-			else
-				printf("ok\n");
-		}
+	mi.size = 0;
+	ret = ioctl(fbdev, OMAPFB_SETUP_MEM, &mi);
+	if (ret != 0)
+		perror("SETUP_MEM");
 
-		close(kbdfd);
-		fclose(tios_f);
+end_fb1:
+	if (fbdev >= 0)
+		close(fbdev);
+
+	kbdfd = open("/dev/tty", O_RDWR);
+	if (kbdfd == -1) {
+		perror("open /dev/tty");
+		return 1;
 	}
 
+	if (ioctl(kbdfd, KDSETMODE, KD_TEXT) == -1)
+		perror("KDSETMODE KD_TEXT");
+
+	close(kbdfd);
+
 	return 0;
 }