aboutsummaryrefslogtreecommitdiffstats
path: root/fb/progress.c
diff options
context:
space:
mode:
authorFlorent Villard <warly@mandriva.com>2002-02-26 13:03:50 +0000
committerFlorent Villard <warly@mandriva.com>2002-02-26 13:03:50 +0000
commit3cff136600d3450105b7f7274f5033895827fa3b (patch)
treecdc43f3d1e61d48ca6c03425c2fb991003158e2d /fb/progress.c
parent0a5f7e13d78f0ca73820ba7308b5244625e29fdd (diff)
downloadbootsplash-3cff136600d3450105b7f7274f5033895827fa3b.tar
bootsplash-3cff136600d3450105b7f7274f5033895827fa3b.tar.gz
bootsplash-3cff136600d3450105b7f7274f5033895827fa3b.tar.bz2
bootsplash-3cff136600d3450105b7f7274f5033895827fa3b.tar.xz
bootsplash-3cff136600d3450105b7f7274f5033895827fa3b.zip
added fb tools:
fbresolution to detect current framebuffer resolution progress to display a colord rectangle in framebuffer
Diffstat (limited to 'fb/progress.c')
-rw-r--r--fb/progress.c398
1 files changed, 398 insertions, 0 deletions
diff --git a/fb/progress.c b/fb/progress.c
new file mode 100644
index 0000000..8a0164a
--- /dev/null
+++ b/fb/progress.c
@@ -0,0 +1,398 @@
+/*
+ * framebuffer tool, inspired from fbi ((c) 1998,99 Gerd Knorr <kraxel@goldbach.in-berlin.de>)
+ *
+ * (c) 2002 Florent Villard (warly@mandrakesoft.com)
+ *
+ */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <unistd.h>
+#include <fcntl.h>
+#include <errno.h>
+#include <termios.h>
+#include <getopt.h>
+#include <sys/ioctl.h>
+#include <sys/mman.h>
+#include <linux/fb.h>
+#include <sys/stat.h>
+#include <linux/kd.h>
+#include <linux/vt.h>
+#include <asm/page.h>
+
+int fd;
+static int fb;
+unsigned char *fb_mem;
+static int tty;
+struct fb_fix_screeninfo fb_fix;
+struct fb_var_screeninfo fb_var;
+static struct fb_var_screeninfo fb_ovar;
+static unsigned short ored[256], ogreen[256], oblue[256];
+static struct fb_cmap ocmap = { 0, 256, ored, ogreen, oblue };
+static int kd_mode;
+static struct vt_mode vt_omode;
+static struct termios term;
+int fb_mem_offset = 0;
+static int orig_vt_no = 0;
+struct termios saved_attributes;
+int saved_fl;
+char *fbdev = NULL;
+
+/* Command line options. */
+struct option progress_options[] = {
+ {"version", no_argument, NULL, 'v'}, /* version */
+ {"help", no_argument, NULL, 'h'}, /* help */
+ {"device", required_argument, NULL, 'd'}, /* device */
+ {"nochange", no_argument, NULL, 'n'},
+ {"tty", required_argument, NULL, 't'},
+ {0,0,0,0}
+};
+
+
+void
+fb_memset (void *addr, int c, size_t len)
+{
+#if 1 /* defined(__powerpc__) */
+ unsigned int i, *p;
+
+ i = (c & 0xff) << 8;
+ i |= i << 16;
+ len >>= 2;
+ for (p = addr; len--; p++)
+ *p = i;
+#else
+ memset(addr, c, len);
+#endif
+}
+
+void
+fb_cleanup(void)
+{
+ /* restore console */
+ if (-1 == ioctl(fb,FBIOPUT_VSCREENINFO,&fb_ovar))
+ perror("ioctl FBIOPUT_VSCREENINFO");
+ if (-1 == ioctl(fb,FBIOGET_FSCREENINFO,&fb_fix))
+ perror("ioctl FBIOGET_FSCREENINFO");
+ if (fb_ovar.bits_per_pixel == 8 ||
+ fb_fix.visual == FB_VISUAL_DIRECTCOLOR) {
+ if (-1 == ioctl(fb,FBIOPUTCMAP,&ocmap))
+ perror("ioctl FBIOPUTCMAP");
+ }
+ close(fb);
+
+ if (-1 == ioctl(tty,KDSETMODE, kd_mode))
+ perror("ioctl KDSETMODE");
+ if (-1 == ioctl(tty,VT_SETMODE, &vt_omode))
+ perror("ioctl VT_SETMODE");
+ if (orig_vt_no && -1 == ioctl(tty,VT_ACTIVATE, orig_vt_no))
+ perror("ioctl VT_ACTIVATE");
+ tcsetattr(tty, TCSANOW, &term);
+ close(tty);
+}
+
+void
+fb_setvt(int vtno, int nochange)
+{
+ struct vt_stat vts;
+ char vtname[12];
+
+ if (-1 == ioctl(tty,VT_GETSTATE, &vts)) {
+ perror("ioctl VT_GETSTATE");
+ exit(1);
+ }
+ orig_vt_no = vts.v_active;
+ if ((orig_vt_no != vtno) && nochange) exit(0);
+
+ if (vtno < 0) {
+ if (-1 == ioctl(tty,VT_OPENQRY, &vtno) || vtno == -1) {
+ perror("ioctl VT_OPENQRY");
+ exit(1);
+ }
+ }
+
+ vtno &= 0xff;
+ sprintf(vtname, "/dev/tty%d", vtno);
+ chown(vtname, getuid(), getgid());
+ if (-1 == access(vtname,R_OK | W_OK)) {
+ fprintf(stderr,"access %s: %s\n",vtname,strerror(errno));
+ exit(1);
+ }
+ switch (fork()) {
+ case 0:
+ break;
+ case -1:
+ perror("fork");
+ exit(1);
+ default:
+ exit(0);
+ }
+ close(tty);
+ close(0);
+ close(1);
+ close(2);
+ setsid();
+ open(vtname,O_RDWR);
+ dup(0);
+ dup(0);
+
+ if (-1 == ioctl(tty,VT_ACTIVATE, vtno)) {
+ perror("ioctl VT_ACTIVATE");
+ exit(1);
+ }
+ if (-1 == ioctl(tty,VT_WAITACTIVE, vtno)) {
+ perror("ioctl VT_WAITACTIVE");
+ exit(1);
+ }
+}
+
+
+int
+fb_init(char *device, int vt, int nochange)
+{
+ struct stat st;
+ char fbdev[16];
+
+ tty = 0;
+ if (vt != 0)
+ fb_setvt(vt,nochange);
+
+ /* FIXME: where are MAJOR() / MINOR() ??? */
+ fstat(tty,&st);
+#if 0
+ if (((st.st_rdev >> 8) & 0xff) != TTY_MAJOR) {
+ /* catch that here, give a more user friendly error message that just
+ * throw a error about a failed ioctl later on ... */
+ fprintf(stderr,
+ "ERROR: tty is not a linux console. You can not start this\n"
+ " tool from a pseudo tty (xterm/ssh/screen/...).\n");
+ exit(1);
+ }
+#endif
+ if (NULL == device) {
+ device = getenv("FRAMEBUFFER");
+ if (NULL == device) {
+ struct fb_con2fbmap c2m;
+ if (-1 == (fb = open("/dev/fb0",O_WRONLY,0))) {
+ fprintf(stderr,"open /dev/fb0: %s\n",strerror(errno));
+ exit(1);
+ }
+ c2m.console = st.st_rdev & 0xff;
+ if (-1 == ioctl(fb, FBIOGET_CON2FBMAP, &c2m)) {
+ perror("ioctl FBIOGET_CON2FBMAP");
+ exit(1);
+ }
+ close(fb);
+ //fprintf(stderr,"map: vt%02d => fb%d\n",c2m.console,c2m.framebuffer);
+ sprintf(fbdev,"/dev/fb%d",c2m.framebuffer);
+ device = fbdev;
+ }
+ }
+ /* get current settings (which we have to restore) */
+ if (-1 == (fb = open(device,O_RDWR /* O_WRONLY */))) {
+ fprintf(stderr,"open %s: %s\n",device,strerror(errno));
+ exit(1);
+ }
+ if (-1 == ioctl(fb,FBIOGET_VSCREENINFO,&fb_ovar)) {
+ perror("ioctl FBIOGET_VSCREENINFO");
+ exit(1);
+ }
+ if (-1 == ioctl(fb,FBIOGET_FSCREENINFO,&fb_fix)) {
+ perror("ioctl FBIOGET_FSCREENINFO");
+ exit(1);
+ }
+ if (fb_ovar.bits_per_pixel == 8 ||
+ fb_fix.visual == FB_VISUAL_DIRECTCOLOR) {
+ if (-1 == ioctl(fb,FBIOGETCMAP,&ocmap)) {
+ perror("ioctl FBIOGETCMAP");
+ exit(1);
+ }
+ }
+ if (-1 == ioctl(tty,KDGETMODE, &kd_mode)) {
+ perror("ioctl KDGETMODE");
+ exit(1);
+ }
+ if (-1 == ioctl(tty,VT_GETMODE, &vt_omode)) {
+ perror("ioctl VT_GETMODE");
+ exit(1);
+ }
+ tcgetattr(tty, &term);
+
+ /* get mode info */
+ if (-1 == ioctl(fb,FBIOGET_VSCREENINFO,&fb_var)) {
+ perror("ioctl FBIOGET_VSCREENINFO");
+ exit(1);
+ }
+
+ /* checks & initialisation */
+ if (-1 == ioctl(fb,FBIOGET_FSCREENINFO,&fb_fix)) {
+ perror("ioctl FBIOGET_FSCREENINFO");
+ exit(1);
+ }
+ if (fb_fix.type != FB_TYPE_PACKED_PIXELS) {
+ fprintf(stderr,"can handle only packed pixel frame buffers\n");
+ goto err;
+ }
+ fb_mem_offset = (unsigned long)(fb_fix.smem_start) & (~PAGE_MASK);
+ fb_mem = mmap(NULL,fb_fix.smem_len+fb_mem_offset,PROT_WRITE,MAP_SHARED,fb,0);
+ if (-1L == (long)fb_mem) {
+ perror("mmap");
+ goto err;
+ }
+ /* move viewport to upper left corner */
+ if (fb_var.xoffset != 0 || fb_var.yoffset != 0) {
+ fb_var.xoffset = 0;
+ fb_var.yoffset = 0;
+ if (-1 == ioctl(fb,FBIOPAN_DISPLAY,&fb_var)) {
+ perror("ioctl FBIOPAN_DISPLAY");
+ goto err;
+ }
+ }
+// if (-1 == ioctl(tty,KDSETMODE, KD_GRAPHICS)) {
+// perror("ioctl KDSETMODE");
+// goto err;
+// }
+
+ /* cls */
+ //fb_memset(fb_mem+fb_mem_offset,0,fb_fix.smem_len);
+ return fb;
+
+ err:
+ fb_cleanup();
+ exit(1);
+}
+
+void
+tty_restore()
+{
+ fcntl(0,F_SETFL,saved_fl);
+ tcsetattr (0, TCSANOW, &saved_attributes);
+}
+
+void
+tty_raw()
+{
+ struct termios tattr;
+
+ fcntl(0,F_GETFL,&saved_fl);
+ tcgetattr (0, &saved_attributes);
+
+ fcntl(0,F_SETFL,O_NONBLOCK);
+ memcpy(&tattr,&saved_attributes,sizeof(struct termios));
+ tattr.c_lflag &= ~(ICANON|ECHO);
+ tattr.c_cc[VMIN] = 1;
+ tattr.c_cc[VTIME] = 0;
+ tcsetattr (0, TCSAFLUSH, &tattr);
+}
+
+void
+version(void)
+{
+ fprintf(stderr, "progress version " VERSION
+ " (c) 2002 Florent Villard <warly@mandrakesoft.com>; compiled on %s.\n", __DATE__ );
+}
+
+void
+usage(char *name)
+{
+ char *h;
+ h = strrchr(name, '/');
+ fprintf(stderr,
+ "\n"
+ "This program displays rectangles using the Linux framebuffer device.\n"
+ "\n"
+ " Usage: %s [ options ] x y dx dy color\n"
+ "\n"
+ " --help [-h] Print this text\n"
+ " --version [-v] Show the %s version number\n"
+ " --device [-d] dev Framebuffer device [%s]\n"
+ " --nochange [-n] Exit if tty is not the current one\n"
+ " --tty [-t] tty Display on a specific tty (actual if omitted)\n"
+ "\n"
+ "\n"
+ ,h ? h + 1 : name, h ? h + 1 : name,fbdev ? fbdev : "/dev/fb0");
+}
+
+
+
+int
+main(int argc, char *argv[])
+{
+ int i,j,bytes;
+ int x,y,X,Y;
+ int color;
+ int opt_index = 0;
+ int c,tty=0;
+ int nochange = 0;
+ char * tab;
+ char * a;
+ for (;;) {
+ c = getopt_long(argc, argv, "vhnd:t:", progress_options, &opt_index);
+ if (c == -1)
+ break;
+ switch (c) {
+ case 'd':
+ fbdev = optarg;
+ break;
+ case 'v':
+ version();
+ exit(1);
+ break;
+ case 'n':
+ nochange=1;
+ break;
+ case 't':
+ tty = atoi(optarg);
+ break;
+ default:
+ case 'h':
+ usage(argv[0]);
+ exit(1);
+ }
+ }
+ if (optind > argc - 5) {
+ usage(argv[0]);
+ exit(1);
+ }
+ fd = fb_init(fbdev, tty, nochange);
+ x = atoi((char *)*(argv+optind++));
+ if ( x > fb_var.xres ) x = 0;
+ y = atoi((char *)*(argv+optind++));
+ if ( y > fb_var.yres ) y = 0;
+ X = atoi((char *)*(argv+optind++));
+ if ( X + x > fb_var.xres ) X = fb_var.xres-x;
+ Y = atoi((char *)*(argv+optind++));
+ if ( Y + y > fb_var.yres ) Y = fb_var.yres-y;
+ color = strtol((char *)*(argv+optind++),NULL,16);
+
+ // printf("x %d y %d X %d Y %d color %x bit per pixel %d red %d green %d blue %d tty %d\n",x,y,X,Y,color,fb_var.bits_per_pixel,fb_var.red.length,fb_var.green.length,fb_var.blue.length,tty);
+ exit;
+ switch (fb_var.bits_per_pixel){
+ case 24: break;
+ case 16:
+ case 15:
+ color = ((color & 0xff0000) >> 16 >> 3 << (fb_var.green.length + fb_var.blue.length)) + ((color & 0x00ff00) >> 8 >> 2 << (fb_var.blue.length)) + ((color & 0x0000ff) >> 3);
+ break;
+ default:
+ perror("unsupported bits per pixel mode");
+ exit(1);
+ }
+ bytes = (fb_var.bits_per_pixel+7)/8;
+ tty_raw();
+ tab = (char *)malloc(sizeof(char)*bytes*X);
+ a = (char *)malloc(sizeof(char)*bytes);
+ for (j = 0; j < bytes; j++){
+ a[j] = color >> (8*j);
+ }
+ for (i = 0; i < X; i++) {
+ for (j = 0; j < bytes; j++){
+ tab[bytes*i+j] = a[j];
+ }
+ memcpy(fb_mem+(y*fb_var.xres+x+i)*bytes, a, bytes);
+ }
+ for (j = 1; j < Y; j++){
+ memcpy(fb_mem+(y+j)*bytes*fb_var.xres+x*bytes, tab, bytes*X);
+ }
+ tty_restore();
+ return 0;
+}