| 1,165 → 1,176 |
|---|
| /* |
| * Project: S.Ha.R.K. |
| * |
| * Coordinators: |
| * Giorgio Buttazzo <giorgio@sssup.it> |
| * Paolo Gai <pj@gandalf.sssup.it> |
| * |
| * Authors : |
| * Giacomo Guidi <giacomo@gandalf.sssup.it> |
| * |
| * ReTiS Lab (Scuola Superiore S.Anna - Pisa - Italy) |
| * |
| * http://www.sssup.it |
| * http://retis.sssup.it |
| * http://shark.sssup.it |
| */ |
| |
| /* |
| * Copyright (C) 2003 Giacomo Guidi |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
| */ |
| |
| #include "kernel/kern.h" |
| #include <drivers/fg.h> |
| #include <drivers/glib.h> |
| #include <drivers/keyb.h> |
| #include <unistd.h> |
| #include <stdlib.h> |
| |
| #define WIDTH 640 |
| #define HEIGHT 480 |
| #define BYTES_PP 2 |
| |
| unsigned char *video_buf = NULL; //Video Buffer |
| unsigned long int VMEMLONG = WIDTH * HEIGHT * BYTES_PP / 4; // Used by copy_videomem_16to16 |
| unsigned long int RGB565MEM = WIDTH * HEIGHT * BYTES_PP; // Total video mem |
| |
| #define FG_PERIOD 40000 |
| #define FG_WCET 30000 |
| #define FG_W 320 |
| #define FG_H 200 |
| |
| unsigned int color = FG_MONO; |
| |
| extern DWORD flbaddr; |
| |
| static void screen() |
| { |
| |
| /* graphic card Initialization */ |
| if (grx_init() < 1) { |
| sys_abort(1); |
| } |
| |
| if (grx_open(640, 480, 16) < 0) { |
| cprintf("GRX Err\n"); |
| sys_abort(1); |
| } |
| |
| video_buf = (unsigned char *)flbaddr; |
| |
| } |
| |
| void program_end(void *arg) |
| { |
| |
| FG_close(); |
| |
| grx_close(); |
| |
| sys_end(); |
| |
| } |
| |
| void program_key_end(KEY_EVT *k) |
| { |
| |
| sys_end(); |
| |
| } |
| |
| void elaborate_image(void *imageptr) |
| { |
| |
| WORD x,y; |
| BYTE *col; |
| |
| if (color == FG_MONO) { |
| |
| for(y = 0; y < FG_H; y++) |
| for(x = 0; x < FG_W; x++) { |
| |
| col = (BYTE *)(imageptr + y*FG_W + x); |
| *(WORD *)(video_buf + y*(WIDTH*2) + (x*2)) = (WORD)rgb16(*(BYTE *)(col),*(BYTE *)(col),*(BYTE *)(col)); |
| |
| } |
| |
| } |
| |
| if (color == FG_RGB24) { |
| |
| for(y = 0; y < FG_H; y++) |
| for(x = 0; x < FG_W; x++) { |
| |
| col = (BYTE *)(imageptr + y*(FG_W*3) + (x*3)); |
| *(WORD *)(video_buf + y*(WIDTH*2) + (x*2)) = (WORD)rgb16(*(BYTE *)(col),*(BYTE *)(col+1),*(BYTE *)(col+2)); |
| |
| } |
| |
| } |
| |
| //printf_xy(0,0,WHITE,"Grabbed = %08lx",*(DWORD *)(imageptr + 50*FG_W + 50)); |
| //printf_xy(0,1,WHITE,"Grabbed = %08lx",*(DWORD *)(imageptr + 51*FG_W + 50)); |
| |
| } |
| |
| int main(int argc, char **argv) |
| { |
| |
| int channel = 0; |
| |
| if (argc < 2) { |
| channel = 0; |
| } else { |
| channel = atoi(argv[1]); |
| } |
| |
| sys_atrunlevel(program_end,NULL, RUNLEVEL_BEFORE_EXIT); |
| |
| { |
| KEY_EVT k; |
| k.flag = ALTL_BIT; |
| k.scan = KEY_C; |
| k.ascii = 'c'; |
| keyb_hook(k,program_key_end); |
| } |
| |
| |
| screen(); |
| //video_buf = malloc(RGB565MEM); |
| |
| sleep(1); |
| |
| FG_init(FG_PERIOD, FG_WCET, FG_W, FG_H, color, channel); |
| |
| FG_set_hook(elaborate_image); |
| |
| FG_start_grabbing(); |
| |
| return 0; |
| |
| } |
| /* |
| * Project: S.Ha.R.K. |
| * |
| * Coordinators: |
| * Giorgio Buttazzo <giorgio@sssup.it> |
| * Paolo Gai <pj@gandalf.sssup.it> |
| * |
| * Authors : |
| * Giacomo Guidi <giacomo@gandalf.sssup.it> |
| * |
| * ReTiS Lab (Scuola Superiore S.Anna - Pisa - Italy) |
| * |
| * http://www.sssup.it |
| * http://retis.sssup.it |
| * http://shark.sssup.it |
| */ |
| |
| /* |
| * Copyright (C) 2003 Giacomo Guidi |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
| */ |
| |
| #include "kernel/kern.h" |
| #include <drivers/fg.h> |
| #include <drivers/vga.h> |
| #include <drivers/keyb.h> |
| #include <unistd.h> |
| #include <stdlib.h> |
| |
| #define WIDTH 640 |
| #define HEIGHT 480 |
| #define BYTES_PP 2 |
| #define INITSTR G640x480x64K //SVGAlib standard mode definitions |
| #define CARD VESA //Video driver |
| |
| unsigned char *video_buf = NULL; //Video Buffer |
| unsigned long int VMEMLONG = WIDTH * HEIGHT * BYTES_PP / 4; // Used by copy_videomem_16to16 |
| unsigned long int RGB565MEM = WIDTH * HEIGHT * BYTES_PP; // Total video mem |
| |
| #define FG_PERIOD 40000 |
| #define FG_WCET 30000 |
| #define FG_W 320 |
| #define FG_H 200 |
| |
| unsigned int color = FG_MONO; |
| |
| static int screen(int mode) |
| { |
| |
| vga_modeinfo *minf; |
| |
| vga_setmode(mode,CARD); |
| minf = vga_getmodeinfo(mode); |
| if(! (minf->flags & CAPABLE_LINEAR)){ |
| vga_setmode(TEXT,CARD); |
| printk(KERN_INFO "The mode %d is not capable of linear\n",mode); |
| return 1; |
| } |
| vga_setpage(0); |
| if(vga_setlinearaddressing() == -1) { |
| vga_setmode(TEXT,CARD); |
| printk(KERN_INFO "Could not set linear addressing for mode %d\n",mode); |
| return 1; |
| } |
| |
| video_buf = vga_getgraphmem(); |
| |
| memset(video_buf, 0, RGB565MEM); |
| |
| grx_setbuffer(video_buf, WIDTH, HEIGHT); //Init of RGBA version of grx functions |
| //created to work with Mesa buffer |
| return 0; |
| |
| } |
| |
| void program_end(void *arg) |
| { |
| |
| FG_close(); |
| |
| vga_setmode(TEXT,CARD); |
| |
| sys_end(); |
| |
| } |
| |
| void program_key_end(KEY_EVT *k) |
| { |
| |
| sys_end(); |
| |
| } |
| |
| void elaborate_image(void *imageptr) |
| { |
| |
| WORD x,y; |
| BYTE *col; |
| |
| if (color == FG_MONO) { |
| |
| for(y = 0; y < FG_H; y++) |
| for(x = 0; x < FG_W; x++) { |
| |
| col = (BYTE *)(imageptr + y*FG_W + x); |
| *(WORD *)(video_buf + y*(WIDTH*2) + (x*2)) = (WORD)rgb16(*(BYTE *)(col),*(BYTE *)(col),*(BYTE *)(col)); |
| |
| } |
| |
| } |
| |
| if (color == FG_RGB24) { |
| |
| for(y = 0; y < FG_H; y++) |
| for(x = 0; x < FG_W; x++) { |
| |
| col = (BYTE *)(imageptr + y*(FG_W*3) + (x*3)); |
| *(WORD *)(video_buf + y*(WIDTH*2) + (x*2)) = (WORD)rgb16(*(BYTE *)(col),*(BYTE *)(col+1),*(BYTE *)(col+2)); |
| |
| } |
| |
| } |
| |
| printf_xy(0,0,WHITE,"Grabbed = %08lx",*(DWORD *)(imageptr + 50*FG_W + 50)); |
| printf_xy(0,1,WHITE,"Grabbed = %08lx",*(DWORD *)(imageptr + 51*FG_W + 50)); |
| |
| } |
| |
| int main(int argc, char **argv) |
| { |
| |
| int channel = 0; |
| |
| if (argc < 2) { |
| channel = 0; |
| } else { |
| channel = atoi(argv[1]); |
| } |
| |
| sys_atrunlevel(program_end,NULL, RUNLEVEL_BEFORE_EXIT); |
| |
| { |
| KEY_EVT k; |
| k.flag = ALTL_BIT; |
| k.scan = KEY_C; |
| k.ascii = 'c'; |
| keyb_hook(k,program_key_end); |
| } |
| |
| //screen(INITSTR); |
| video_buf = malloc(RGB565MEM); |
| |
| sleep(1); |
| |
| FG_init(FG_PERIOD, FG_WCET, FG_W, FG_H, color, channel); |
| |
| FG_set_hook(elaborate_image); |
| |
| FG_start_grabbing(); |
| |
| return 0; |
| |
| } |