Subversion Repositories HelenOS-historic

Rev

Rev 1404 | Rev 1447 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. /*
  2.  * Copyright (C) 2006 Jakub Vana
  3.  * Copyright (C) 2006 Ondrej Palkovsky
  4.  * All rights reserved.
  5.  *
  6.  * Redistribution and use in source and binary forms, with or without
  7.  * modification, are permitted provided that the following conditions
  8.  * are met:
  9.  *
  10.  * - Redistributions of source code must retain the above copyright
  11.  *   notice, this list of conditions and the following disclaimer.
  12.  * - Redistributions in binary form must reproduce the above copyright
  13.  *   notice, this list of conditions and the following disclaimer in the
  14.  *   documentation and/or other materials provided with the distribution.
  15.  * - The name of the author may not be used to endorse or promote products
  16.  *   derived from this software without specific prior written permission.
  17.  *
  18.  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  19.  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  20.  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  21.  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  22.  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  23.  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  24.  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  25.  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  26.  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  27.  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  28.  */
  29.  
  30. #include <stdio.h>
  31. #include <stdlib.h>
  32. #include <unistd.h>
  33. #include <string.h>
  34. #include <ddi.h>
  35. #include <task.h>
  36. #include <sysinfo.h>
  37. #include <align.h>
  38. #include <as.h>
  39. #include <ipc/fb.h>
  40. #include <ipc/ipc.h>
  41. #include <ipc/ns.h>
  42. #include <ipc/services.h>
  43. #include <kernel/errno.h>
  44. #include <async.h>
  45. #include "font-8x16.h"
  46. #include "helenos.xbm"
  47. #include "fb.h"
  48.  
  49. #define EFB (-1)
  50.  
  51. #define DEFAULT_BGCOLOR     0x000080
  52. #define DEFAULT_FGCOLOR     0xffff00
  53. #define DEFAULT_LOGOCOLOR   0x0000ff
  54.  
  55. #define MAIN_BGCOLOR        0x404000
  56. #define MAIN_FGCOLOR        0x000000
  57. #define MAIN_LOGOCOLOR  0x404000
  58.  
  59. #define SPACING (2)
  60.  
  61. #define H_NO_VFBS 3
  62. #define V_NO_VFBS 3
  63.  
  64. static void fb_putchar(int item,char ch);
  65. int create_window(int item,unsigned int x, unsigned int y,unsigned int x_size, unsigned int y_size,
  66.     unsigned int BGCOLOR,unsigned int FGCOLOR,unsigned int LOGOCOLOR);
  67. void fb_init(int item,__address addr, unsigned int x, unsigned int y, unsigned int bpp, unsigned int scan,
  68.     unsigned int BGCOLOR,unsigned int FGCOLOR,unsigned int LOGOCOLOR);
  69.  
  70. unsigned int mod_col(unsigned int col,int mod);
  71.  
  72. static int init_fb(void)
  73. {
  74.     __address fb_ph_addr;
  75.     unsigned int fb_width;
  76.     unsigned int fb_height;
  77.     unsigned int fb_bpp;
  78.     unsigned int fb_scanline;
  79.     __address fb_addr;
  80.     int a=0;
  81.     int i,j,k;
  82.     int w;
  83.     char text[]="HelenOS Framebuffer driver\non Virtual Framebuffer\nVFB ";
  84.  
  85.     fb_ph_addr=sysinfo_value("fb.address.physical");
  86.     fb_width=sysinfo_value("fb.width");
  87.     fb_height=sysinfo_value("fb.height");
  88.     fb_bpp=sysinfo_value("fb.bpp");
  89.     fb_scanline=sysinfo_value("fb.scanline");
  90.  
  91.     fb_addr=ALIGN_UP(((__address)set_maxheapsize(USER_ADDRESS_SPACE_SIZE_ARCH>>1)),PAGE_SIZE);
  92.    
  93.     map_physmem(task_get_id(),(void *)((__address)fb_ph_addr),(void *)fb_addr,
  94.             (fb_scanline*fb_height+PAGE_SIZE-1)>>PAGE_WIDTH,
  95.             AS_AREA_READ | AS_AREA_WRITE | AS_AREA_CACHEABLE);
  96.    
  97.     fb_init(0,fb_addr, fb_width, fb_height, fb_bpp, fb_scanline,
  98.         MAIN_BGCOLOR,MAIN_FGCOLOR,MAIN_LOGOCOLOR);
  99.  
  100.     fb_putchar(0,'\n');
  101.     fb_putchar(0,' ');
  102.  
  103.     for(i=0;i<H_NO_VFBS;i++)
  104.         for(j=0;j<V_NO_VFBS;j++) {
  105.             w = create_window(0,(fb_width/H_NO_VFBS)*i+SPACING,
  106.                       (fb_height/V_NO_VFBS)*j+SPACING,(fb_width/H_NO_VFBS)-2*SPACING ,
  107.                       (fb_height/V_NO_VFBS)-2*SPACING,mod_col(DEFAULT_BGCOLOR,/*i+j*H_NO_VFBS*/0),
  108.                       mod_col(DEFAULT_FGCOLOR,/*i+j*H_NO_VFBS*/0),
  109.                       mod_col(DEFAULT_LOGOCOLOR,/*i+j*H_NO_VFBS)*/0));
  110.            
  111.             if( w== EFB)
  112.                 return -1;
  113.            
  114.             for(k=0;text[k];k++)
  115.                 fb_putchar(w,text[k]);
  116.             fb_putchar(w,w+'0');
  117.             fb_putchar(w,'\n');
  118.         }
  119.     return 0;
  120. }
  121.  
  122. int vfb_no = 1;
  123. void client_connection(ipc_callid_t iid, ipc_call_t *icall)
  124. {
  125.     ipc_callid_t callid;
  126.     ipc_call_t call;
  127.     int vfb = vfb_no++;
  128.  
  129.     if (vfb > 9) {
  130.         ipc_answer_fast(iid, ELIMIT, 0,0);
  131.         return;
  132.     }
  133.     ipc_answer_fast(iid, 0, 0, 0);
  134.  
  135.     while (1) {
  136.         callid = async_get_call(&call);
  137.         switch (IPC_GET_METHOD(call)) {
  138.         case IPC_M_PHONE_HUNGUP:
  139.             ipc_answer_fast(callid,0,0,0);
  140.             return; /* Exit thread */
  141.  
  142.         case FB_PUTCHAR:
  143.             ipc_answer_fast(callid,0,0,0);
  144.             fb_putchar(vfb,IPC_GET_ARG2(call));
  145.             break;
  146.         default:
  147.             ipc_answer_fast(callid,ENOENT,0,0);
  148.         }
  149.     }
  150. }
  151.  
  152. int main(int argc, char *argv[])
  153. {
  154.     ipc_call_t call;
  155.     ipc_callid_t callid;
  156.     char connected = 0;
  157.     int res;
  158.     int c;
  159.     ipcarg_t phonead;
  160.    
  161.     ipcarg_t retval, arg1, arg2;
  162.  
  163.     if(!sysinfo_value("fb")) return -1;
  164.  
  165.  
  166.     if ((res = ipc_connect_to_me(PHONE_NS, SERVICE_VIDEO, 0, &phonead)) != 0)
  167.         return -1;
  168.    
  169.     init_fb();
  170.  
  171.     async_manager();
  172.     /* Never reached */
  173.     return 0;
  174. }
  175.  
  176.  
  177. #define GRAPHICS_ITEMS 1024
  178.  
  179.  
  180. /***************************************************************/
  181. /* Pixel specific fuctions */
  182.  
  183. typedef void (*putpixel_fn_t)(int item,unsigned int x, unsigned int y, int color);
  184. typedef int (*getpixel_fn_t)(int item,unsigned int x, unsigned int y);
  185.  
  186. typedef struct framebuffer_descriptor
  187. {
  188.     __u8 *fbaddress ;
  189.  
  190.     unsigned int xres ;
  191.     unsigned int yres ;
  192.     unsigned int scanline ;
  193.     unsigned int pixelbytes ;
  194.  
  195.     unsigned int position ;
  196.     unsigned int columns ;
  197.     unsigned int rows ;
  198.    
  199.     unsigned int BGCOLOR;
  200.     unsigned int FGCOLOR;
  201.     unsigned int LOGOCOLOR;
  202.    
  203.     putpixel_fn_t putpixel;
  204.     getpixel_fn_t getpixel;
  205.    
  206. }framebuffer_descriptor_t;
  207.  
  208. void * graphics_items[GRAPHICS_ITEMS+1]={NULL};
  209.  
  210. #define FB(__a__,__b__) (((framebuffer_descriptor_t*)(graphics_items[__a__]))->__b__)
  211.  
  212. #define COL_WIDTH   8
  213. #define ROW_BYTES   (FB(item,scanline) * FONT_SCANLINES)
  214. #define RED(x, bits)    ((x >> (16 + 8 - bits)) & ((1 << bits) - 1))
  215. #define GREEN(x, bits)  ((x >> (8 + 8 - bits)) & ((1 << bits) - 1))
  216. #define BLUE(x, bits)   ((x >> (8 - bits)) & ((1 << bits) - 1))
  217.  
  218. #define POINTPOS(x, y)  (y * FB(item,scanline) + x * FB(item,pixelbytes))
  219.  
  220.  
  221.  
  222.  
  223. /** Put pixel - 24-bit depth, 1 free byte */
  224. static void putpixel_4byte(int item,unsigned int x, unsigned int y, int color)
  225. {
  226.     *((__u32 *)(FB(item,fbaddress) + POINTPOS(x, y))) = color;
  227. }
  228.  
  229. /** Return pixel color - 24-bit depth, 1 free byte */
  230. static int getpixel_4byte(int item,unsigned int x, unsigned int y)
  231. {
  232.     return *((__u32 *)(FB(item,fbaddress) + POINTPOS(x, y))) & 0xffffff;
  233. }
  234.  
  235. /** Put pixel - 24-bit depth */
  236. static void putpixel_3byte(int item,unsigned int x, unsigned int y, int color)
  237. {
  238.     unsigned int startbyte = POINTPOS(x, y);
  239.  
  240. #if (defined(BIG_ENDIAN) || defined(FB_BIG_ENDIAN))
  241.     FB(item,fbaddress)[startbyte] = RED(color, 8);
  242.     FB(item,fbaddress)[startbyte + 1] = GREEN(color, 8);
  243.     FB(item,fbaddress)[startbyte + 2] = BLUE(color, 8);
  244. #else
  245.     FB(item,fbaddress)[startbyte + 2] = RED(color, 8);
  246.     FB(item,fbaddress)[startbyte + 1] = GREEN(color, 8);
  247.     FB(item,fbaddress)[startbyte + 0] = BLUE(color, 8);
  248. #endif
  249.  
  250. }
  251.  
  252. /** Return pixel color - 24-bit depth */
  253. static int getpixel_3byte(int item,unsigned int x, unsigned int y)
  254. {
  255.     unsigned int startbyte = POINTPOS(x, y);
  256.  
  257.  
  258.  
  259. #if (defined(BIG_ENDIAN) || defined(FB_BIG_ENDIAN))
  260.     return FB(item,fbaddress)[startbyte] << 16 | FB(item,fbaddress)[startbyte + 1] << 8 | FB(item,fbaddress)[startbyte + 2];
  261. #else
  262.     return FB(item,fbaddress)[startbyte + 2] << 16 | FB(item,fbaddress)[startbyte + 1] << 8 | FB(item,fbaddress)[startbyte + 0];
  263. #endif
  264.                                
  265.  
  266. }
  267.  
  268. /** Put pixel - 16-bit depth (5:6:5) */
  269. static void putpixel_2byte(int item,unsigned int x, unsigned int y, int color)
  270. {
  271.     /* 5-bit, 6-bits, 5-bits */
  272.     *((__u16 *)(FB(item,fbaddress) + POINTPOS(x, y))) = RED(color, 5) << 11 | GREEN(color, 6) << 5 | BLUE(color, 5);
  273. }
  274.  
  275. /** Return pixel color - 16-bit depth (5:6:5) */
  276. static int getpixel_2byte(int item,unsigned int x, unsigned int y)
  277. {
  278.     int color = *((__u16 *)(FB(item,fbaddress) + POINTPOS(x, y)));
  279.     return (((color >> 11) & 0x1f) << (16 + 3)) | (((color >> 5) & 0x3f) << (8 + 2)) | ((color & 0x1f) << 3);
  280. }
  281.  
  282. /** Put pixel - 8-bit depth (3:2:3) */
  283. static void putpixel_1byte(int item,unsigned int x, unsigned int y, int color)
  284. {
  285.     FB(item,fbaddress)[POINTPOS(x, y)] = RED(color, 3) << 5 | GREEN(color, 2) << 3 | BLUE(color, 3);
  286. }
  287.  
  288. /** Return pixel color - 8-bit depth (3:2:3) */
  289. static int getpixel_1byte(int item,unsigned int x, unsigned int y)
  290. {
  291.     int color = FB(item,fbaddress)[POINTPOS(x, y)];
  292.     return (((color >> 5) & 0x7) << (16 + 5)) | (((color >> 3) & 0x3) << (8 + 6)) | ((color & 0x7) << 5);
  293. }
  294.  
  295. /** Fill line with color BGCOLOR */
  296. static void clear_line(int item,unsigned int y)
  297. {
  298.     unsigned int x;
  299.     for (x = 0; x < FB(item,xres); x++)
  300.         FB(item,putpixel)(item,x, y, FB(item,BGCOLOR));
  301. }
  302.  
  303.  
  304. /** Fill screen with background color */
  305. static void clear_screen(int item)
  306. {
  307.     unsigned int y;
  308.     for (y = 0; y < FB(item,yres); y++)
  309.     {
  310.         clear_line(item,y);
  311.     }  
  312. }
  313.  
  314.  
  315. /** Scroll screen one row up */
  316. static void scroll_screen(int item)
  317. {
  318.     unsigned int i;
  319.     unsigned int j;
  320.  
  321.     for(j=0;j<FB(item,yres)-FONT_SCANLINES;j++)
  322.         memcpy((void *) FB(item,fbaddress)+j*FB(item,scanline),
  323.             (void *) &FB(item,fbaddress)[ROW_BYTES+j*FB(item,scanline)], FB(item,pixelbytes)*FB(item,xres));
  324.  
  325.     //memcpy((void *) FB(item,fbaddress), (void *) &FB(item,fbaddress)[ROW_BYTES], FB(item,scanline) * FB(item,yres) - ROW_BYTES);
  326.  
  327.     /* Clear last row */
  328.     for (i = 0; i < FONT_SCANLINES; i++)
  329.         clear_line(item,(FB(item,rows) - 1) * FONT_SCANLINES + i);
  330. }
  331.  
  332.  
  333. static void invert_pixel(int item,unsigned int x, unsigned int y)
  334. {
  335.     FB(item,putpixel)(item, x, y, ~FB(item,getpixel)(item, x, y));
  336. }
  337.  
  338.  
  339. /** Draw one line of glyph at a given position */
  340. static void draw_glyph_line(int item,unsigned int glline, unsigned int x, unsigned int y)
  341. {
  342.     unsigned int i;
  343.  
  344.     for (i = 0; i < 8; i++)
  345.         if (glline & (1 << (7 - i))) {
  346.             FB(item,putpixel)(item,x + i, y, FB(item,FGCOLOR));
  347.         } else
  348.             FB(item,putpixel)(item,x + i, y, FB(item,BGCOLOR));
  349. }
  350.  
  351. /***************************************************************/
  352. /* Character-console functions */
  353.  
  354. /** Draw character at given position */
  355. static void draw_glyph(int item,__u8 glyph, unsigned int col, unsigned int row)
  356. {
  357.     unsigned int y;
  358.  
  359.     for (y = 0; y < FONT_SCANLINES; y++)
  360.         draw_glyph_line(item ,fb_font[glyph * FONT_SCANLINES + y], col * COL_WIDTH, row * FONT_SCANLINES + y);
  361. }
  362.  
  363. /** Invert character at given position */
  364. static void invert_char(int item,unsigned int col, unsigned int row)
  365. {
  366.     unsigned int x;
  367.     unsigned int y;
  368.  
  369.     for (x = 0; x < COL_WIDTH; x++)
  370.         for (y = 0; y < FONT_SCANLINES; y++)
  371.             invert_pixel(item,col * COL_WIDTH + x, row * FONT_SCANLINES + y);
  372. }
  373.  
  374. /** Draw character at default position */
  375. static void draw_char(int item,char chr)
  376. {
  377.     draw_glyph(item ,chr, FB(item,position) % FB(item,columns), FB(item,position) / FB(item,columns));
  378. }
  379.  
  380. static void draw_logo(int item,unsigned int startx, unsigned int starty)
  381. {
  382.     unsigned int x;
  383.     unsigned int y;
  384.     unsigned int byte;
  385.     unsigned int rowbytes;
  386.  
  387.     rowbytes = (helenos_width - 1) / 8 + 1;
  388.  
  389.     for (y = 0; y < helenos_height; y++)
  390.         for (x = 0; x < helenos_width; x++) {
  391.             byte = helenos_bits[rowbytes * y + x / 8];
  392.             byte >>= x % 8;
  393.             if (byte & 1)
  394.                 FB(item,putpixel)(item,startx + x, starty + y, FB(item,LOGOCOLOR));
  395.         }
  396. }
  397.  
  398. /***************************************************************/
  399. /* Stdout specific functions */
  400.  
  401. static void invert_cursor(int item)
  402. {
  403.     invert_char(item,FB(item,position) % FB(item,columns), FB(item,position) / FB(item,columns));
  404. }
  405.  
  406. /** Print character to screen
  407.  *
  408.  *  Emulate basic terminal commands
  409.  */
  410. static void fb_putchar(int item,char ch)
  411. {
  412.    
  413.     switch (ch) {
  414.         case '\n':
  415.             invert_cursor(item);
  416.             FB(item,position) += FB(item,columns);
  417.             FB(item,position) -= FB(item,position) % FB(item,columns);
  418.             break;
  419.         case '\r':
  420.             invert_cursor(item);
  421.             FB(item,position) -= FB(item,position) % FB(item,columns);
  422.             break;
  423.         case '\b':
  424.             invert_cursor(item);
  425.             if (FB(item,position) % FB(item,columns))
  426.                 FB(item,position)--;
  427.             break;
  428.         case '\t':
  429.             invert_cursor(item);
  430.             do {
  431.                 draw_char(item,' ');
  432.                 FB(item,position)++;
  433.             } while (FB(item,position) % 8);
  434.             break;
  435.         default:
  436.             draw_char(item,ch);
  437.             FB(item,position)++;
  438.     }
  439.    
  440.     if (FB(item,position) >= FB(item,columns) * FB(item,rows)) {
  441.         FB(item,position) -= FB(item,columns);
  442.         scroll_screen(item);
  443.     }
  444.    
  445.     invert_cursor(item);
  446.    
  447. }
  448.  
  449.  
  450. /** Initialize framebuffer as a chardev output device
  451.  *
  452.  * @param addr Address of theframebuffer
  453.  * @param x    Screen width in pixels
  454.  * @param y    Screen height in pixels
  455.  * @param bpp  Bits per pixel (8, 16, 24, 32)
  456.  * @param scan Bytes per one scanline
  457.  *
  458.  */
  459. void fb_init(int item,__address addr, unsigned int x, unsigned int y, unsigned int bpp, unsigned int scan,
  460.     unsigned int BGCOLOR,unsigned int FGCOLOR,unsigned int LOGOCOLOR)
  461. {
  462.    
  463.     if( (graphics_items[item]=malloc(sizeof(framebuffer_descriptor_t))) ==NULL)
  464.     {
  465.         return;
  466.     }
  467.  
  468.     switch (bpp) {
  469.         case 8:
  470.             FB(item,putpixel) = putpixel_1byte;
  471.             FB(item,getpixel) = getpixel_1byte;
  472.             FB(item,pixelbytes) = 1;
  473.             break;
  474.         case 16:
  475.             FB(item,putpixel) = putpixel_2byte;
  476.             FB(item,getpixel) = getpixel_2byte;
  477.             FB(item,pixelbytes) = 2;
  478.             break;
  479.         case 24:
  480.             FB(item,putpixel) = putpixel_3byte;
  481.             FB(item,getpixel) = getpixel_3byte;
  482.             FB(item,pixelbytes) = 3;
  483.             break;
  484.         case 32:
  485.             FB(item,putpixel) = putpixel_4byte;
  486.             FB(item,getpixel) = getpixel_4byte;
  487.             FB(item,pixelbytes) = 4;
  488.             break;
  489.     }
  490.  
  491.        
  492.     FB(item,fbaddress) = (unsigned char *) addr;
  493.     FB(item,xres) = x;
  494.     FB(item,yres) = y;
  495.     FB(item,scanline) = scan;
  496.    
  497.    
  498.     FB(item,rows) = y / FONT_SCANLINES;
  499.     FB(item,columns) = x / COL_WIDTH;
  500.  
  501.     FB(item,BGCOLOR)=BGCOLOR;
  502.     FB(item,FGCOLOR)=FGCOLOR;
  503.     FB(item,LOGOCOLOR)=LOGOCOLOR;
  504.  
  505.  
  506.     clear_screen(item);
  507.     draw_logo(item,FB(item,xres) - helenos_width, 0);
  508.     invert_cursor(item);
  509.  
  510. }
  511.  
  512.  
  513. static int get_free_item()
  514. {
  515.     int item;
  516.     for(item=0;graphics_items[item]!=NULL;item++);
  517.     return (item==GRAPHICS_ITEMS)?EFB:item;
  518. }
  519.  
  520. unsigned int mod_col(unsigned int col,int mod)
  521. {
  522.     if(mod & 1) col^=0xff;
  523.     if(mod & 2) col^=0xff00;
  524.     if(mod & 4) col^=0xff0000;
  525.     return col;
  526. }
  527.  
  528.  
  529. int create_window(int item,unsigned int x, unsigned int y,unsigned int x_size, unsigned int y_size,
  530.     unsigned int BGCOLOR,unsigned int FGCOLOR,unsigned int LOGOCOLOR)
  531. {
  532.     int item_new;
  533.    
  534.     if(EFB==(item_new=get_free_item()))return EFB;
  535.    
  536.    
  537.     if( (graphics_items[item_new]=malloc(sizeof(framebuffer_descriptor_t))) ==NULL)
  538.     {
  539.         return EFB;
  540.     }
  541.    
  542.    
  543.    
  544.     FB(item_new,putpixel) = FB(item,putpixel);
  545.     FB(item_new,getpixel) = FB(item,getpixel);
  546.     FB(item_new,pixelbytes) = FB(item,pixelbytes);
  547.  
  548.     FB(item_new,fbaddress) = FB(item,fbaddress) + POINTPOS(x, y) ;
  549.     FB(item_new,xres) = x_size;
  550.     FB(item_new,yres) = y_size;
  551.     FB(item_new,scanline) =  FB(item,scanline);
  552.    
  553.  
  554.     FB(item_new,rows) = y_size / FONT_SCANLINES;
  555.     FB(item_new,columns) = x_size / COL_WIDTH;
  556.  
  557.     FB(item_new,BGCOLOR)=BGCOLOR;
  558.     FB(item_new,FGCOLOR)=FGCOLOR;
  559.     FB(item_new,LOGOCOLOR)=LOGOCOLOR;
  560.  
  561.  
  562.     clear_screen(item_new);
  563.     draw_logo(item_new,FB(item_new,xres) - helenos_width, 0);
  564.     invert_cursor(item_new);
  565.  
  566.     return item_new;
  567. }
  568.  
  569.  
  570.  
  571.