input: in_gp2x refactoring

[libpicofe.git] / pandora / picorestore.c

diff --git a/pandora/picorestore.c b/pandora/picorestore.c
index 6a32755..77f5720 100644 (file)
--- 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;
 }