Subversion Repositories HelenOS

Rev

Rev 1869 | Rev 1875 | Go to most recent revision | Only display areas with differences | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1869 Rev 1871
1
/*
1
/*
2
 * Copyright (C) 2006 Ondrej Palkovsky
2
 * Copyright (C) 2006 Ondrej Palkovsky
3
 * All rights reserved.
3
 * All rights reserved.
4
 *
4
 *
5
 * Redistribution and use in source and binary forms, with or without
5
 * Redistribution and use in source and binary forms, with or without
6
 * modification, are permitted provided that the following conditions
6
 * modification, are permitted provided that the following conditions
7
 * are met:
7
 * are met:
8
 *
8
 *
9
 * - Redistributions of source code must retain the above copyright
9
 * - Redistributions of source code must retain the above copyright
10
 *   notice, this list of conditions and the following disclaimer.
10
 *   notice, this list of conditions and the following disclaimer.
11
 * - Redistributions in binary form must reproduce the above copyright
11
 * - Redistributions in binary form must reproduce the above copyright
12
 *   notice, this list of conditions and the following disclaimer in the
12
 *   notice, this list of conditions and the following disclaimer in the
13
 *   documentation and/or other materials provided with the distribution.
13
 *   documentation and/or other materials provided with the distribution.
14
 * - The name of the author may not be used to endorse or promote products
14
 * - The name of the author may not be used to endorse or promote products
15
 *   derived from this software without specific prior written permission.
15
 *   derived from this software without specific prior written permission.
16
 *
16
 *
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27
 */
27
 */
28
 
28
 
29
/** @addtogroup genarch
29
/** @addtogroup genarch
30
 * @{
30
 * @{
31
 */
31
 */
32
/** @file
32
/** @file
33
 */
33
 */
34
 
34
 
35
#include <genarch/fb/font-8x16.h>
35
#include <genarch/fb/font-8x16.h>
36
#include <genarch/fb/fb.h>
36
#include <genarch/fb/fb.h>
37
#include <console/chardev.h>
37
#include <console/chardev.h>
38
#include <console/console.h>
38
#include <console/console.h>
39
#include <sysinfo/sysinfo.h>
39
#include <sysinfo/sysinfo.h>
40
#include <mm/slab.h>
40
#include <mm/slab.h>
41
#include <align.h>
41
#include <align.h>
42
#include <panic.h>
42
#include <panic.h>
43
#include <memstr.h>
43
#include <memstr.h>
44
#include <config.h>
44
#include <config.h>
45
#include <bitops.h>
45
#include <bitops.h>
46
#include <print.h>
46
#include <print.h>
47
 
47
 
48
#include "helenos.xbm"
48
#include "helenos.xbm"
49
 
49
 
50
SPINLOCK_INITIALIZE(fb_lock);
50
SPINLOCK_INITIALIZE(fb_lock);
51
 
51
 
52
static uint8_t *fbaddress = NULL;
52
static uint8_t *fbaddress = NULL;
53
 
53
 
54
static uint8_t *blankline = NULL;
54
static uint8_t *blankline = NULL;
55
static uint8_t *dbbuffer = NULL; /* Buffer for fast scrolling console */
55
static uint8_t *dbbuffer = NULL; /* Buffer for fast scrolling console */
56
static int dboffset;
56
static int dboffset;
57
 
57
 
58
static unsigned int xres = 0;
58
static unsigned int xres = 0;
59
static unsigned int yres = 0;
59
static unsigned int yres = 0;
60
static unsigned int scanline = 0;
60
static unsigned int scanline = 0;
61
static unsigned int bitspp = 0;
61
static unsigned int bitspp = 0;
62
static unsigned int pixelbytes = 0;
62
static unsigned int pixelbytes = 0;
63
 
63
 
64
static unsigned int position = 0;
64
static unsigned int position = 0;
65
static unsigned int columns = 0;
65
static unsigned int columns = 0;
66
static unsigned int rows = 0;
66
static unsigned int rows = 0;
67
 
67
 
68
 
68
 
69
#define COL_WIDTH   8
69
#define COL_WIDTH   8
70
#define ROW_BYTES   (scanline * FONT_SCANLINES)
70
#define ROW_BYTES   (scanline * FONT_SCANLINES)
71
 
71
 
72
#define BGCOLOR     0x000080
72
#define BGCOLOR     0x000080
73
#define FGCOLOR     0xffff00
73
#define FGCOLOR     0xffff00
74
#define LOGOCOLOR   0x2020b0
74
#define LOGOCOLOR   0x2020b0
75
 
75
 
76
#define RED(x, bits)    ((x >> (16 + 8 - bits)) & ((1 << bits) - 1))
76
#define RED(x, bits)    ((x >> (16 + 8 - bits)) & ((1 << bits) - 1))
77
#define GREEN(x, bits)  ((x >> (8 + 8 - bits)) & ((1 << bits) - 1))
77
#define GREEN(x, bits)  ((x >> (8 + 8 - bits)) & ((1 << bits) - 1))
78
#define BLUE(x, bits)   ((x >> (8 - bits)) & ((1 << bits) - 1))
78
#define BLUE(x, bits)   ((x >> (8 - bits)) & ((1 << bits) - 1))
79
 
79
 
80
#define POINTPOS(x, y)  ((y) * scanline + (x) * pixelbytes)
80
#define POINTPOS(x, y)  ((y) * scanline + (x) * pixelbytes)
81
 
81
 
82
/***************************************************************/
82
/***************************************************************/
83
/* Pixel specific fuctions */
83
/* Pixel specific fuctions */
84
 
84
 
85
static void (*rgb2scr)(void *, int);
85
static void (*rgb2scr)(void *, int);
86
static int (*scr2rgb)(void *);
86
static int (*scr2rgb)(void *);
87
 
87
 
88
/* Conversion routines between different color representations */
88
/* Conversion routines between different color representations */
89
static void rgb_4byte(void *dst, int rgb)
89
static void rgb_4byte(void *dst, int rgb)
90
{
90
{
91
    *(int *)dst = rgb;
91
    *(int *)dst = rgb;
92
}
92
}
93
 
93
 
94
static int byte4_rgb(void *src)
94
static int byte4_rgb(void *src)
95
{
95
{
96
    return (*(int *)src) & 0xffffff;
96
    return (*(int *)src) & 0xffffff;
97
}
97
}
98
 
98
 
99
static void rgb_3byte(void *dst, int rgb)
99
static void rgb_3byte(void *dst, int rgb)
100
{
100
{
101
    uint8_t *scr = dst;
101
    uint8_t *scr = dst;
102
#if (defined(BIG_ENDIAN) || defined(FB_BIG_ENDIAN))
102
#if defined(FB_INVERT_ENDIAN)
103
    scr[0] = RED(rgb, 8);
103
    scr[0] = RED(rgb, 8);
104
    scr[1] = GREEN(rgb, 8);
104
    scr[1] = GREEN(rgb, 8);
105
    scr[2] = BLUE(rgb, 8);
105
    scr[2] = BLUE(rgb, 8);
106
#else
106
#else
107
    scr[2] = RED(rgb, 8);
107
    scr[2] = RED(rgb, 8);
108
    scr[1] = GREEN(rgb, 8);
108
    scr[1] = GREEN(rgb, 8);
109
    scr[0] = BLUE(rgb, 8);
109
    scr[0] = BLUE(rgb, 8);
110
#endif
110
#endif
111
}
111
}
112
 
112
 
113
static int byte3_rgb(void *src)
113
static int byte3_rgb(void *src)
114
{
114
{
115
    uint8_t *scr = src;
115
    uint8_t *scr = src;
116
#if (defined(BIG_ENDIAN) || defined(FB_BIG_ENDIAN))
116
#if defined(FB_INVERT_ENDIAN)
117
    return scr[0] << 16 | scr[1] << 8 | scr[2];
117
    return scr[0] << 16 | scr[1] << 8 | scr[2];
118
#else
118
#else
119
    return scr[2] << 16 | scr[1] << 8 | scr[0];
119
    return scr[2] << 16 | scr[1] << 8 | scr[0];
120
#endif  
120
#endif  
121
}
121
}
122
 
122
 
123
/**  16-bit depth (5:6:5) */
123
/**  16-bit depth (5:6:5) */
124
static void rgb_2byte(void *dst, int rgb)
124
static void rgb_2byte(void *dst, int rgb)
125
{
125
{
126
    /* 5-bit, 6-bits, 5-bits */
126
    /* 5-bit, 6-bits, 5-bits */
127
    *((uint16_t *)(dst)) = RED(rgb, 5) << 11 | GREEN(rgb, 6) << 5 | BLUE(rgb, 5);
127
    *((uint16_t *)(dst)) = RED(rgb, 5) << 11 | GREEN(rgb, 6) << 5 | BLUE(rgb, 5);
128
}
128
}
129
 
129
 
130
/** 16-bit depth (5:6:5) */
130
/** 16-bit depth (5:6:5) */
131
static int byte2_rgb(void *src)
131
static int byte2_rgb(void *src)
132
{
132
{
133
    int color = *(uint16_t *)(src);
133
    int color = *(uint16_t *)(src);
134
    return (((color >> 11) & 0x1f) << (16 + 3)) | (((color >> 5) & 0x3f) << (8 + 2)) | ((color & 0x1f) << 3);
134
    return (((color >> 11) & 0x1f) << (16 + 3)) | (((color >> 5) & 0x3f) << (8 + 2)) | ((color & 0x1f) << 3);
135
}
135
}
136
 
136
 
137
/** Put pixel - 8-bit depth (color palette/3:2:3)
137
/** Put pixel - 8-bit depth (color palette/3:2:3)
138
 *
138
 *
139
 * Even though we try 3:2:3 color scheme here, an 8-bit framebuffer
139
 * Even though we try 3:2:3 color scheme here, an 8-bit framebuffer
140
 * will most likely use a color palette. The color appearance
140
 * will most likely use a color palette. The color appearance
141
 * will be pretty random and depend on the default installed
141
 * will be pretty random and depend on the default installed
142
 * palette. This could be fixed by supporting custom palette
142
 * palette. This could be fixed by supporting custom palette
143
 * and setting it to simulate the 8-bit truecolor.
143
 * and setting it to simulate the 8-bit truecolor.
144
 */
144
 */
145
static void rgb_1byte(void *dst, int rgb)
145
static void rgb_1byte(void *dst, int rgb)
146
{
146
{
147
    *(uint8_t *)dst = RED(rgb, 3) << 5 | GREEN(rgb, 2) << 3 | BLUE(rgb, 3);
147
    *(uint8_t *)dst = RED(rgb, 3) << 5 | GREEN(rgb, 2) << 3 | BLUE(rgb, 3);
148
}
148
}
149
 
149
 
150
/** Return pixel color - 8-bit depth (color palette/3:2:3)
150
/** Return pixel color - 8-bit depth (color palette/3:2:3)
151
 *
151
 *
152
 * See the comment for rgb_1byte().
152
 * See the comment for rgb_1byte().
153
 */
153
 */
154
static int byte1_rgb(void *src)
154
static int byte1_rgb(void *src)
155
{
155
{
156
    int color = *(uint8_t *)src;
156
    int color = *(uint8_t *)src;
157
    return (((color >> 5) & 0x7) << (16 + 5)) | (((color >> 3) & 0x3) << (8 + 6)) | ((color & 0x7) << 5);
157
    return (((color >> 5) & 0x7) << (16 + 5)) | (((color >> 3) & 0x3) << (8 + 6)) | ((color & 0x7) << 5);
158
}
158
}
159
 
159
 
160
static void putpixel(unsigned int x, unsigned int y, int color)
160
static void putpixel(unsigned int x, unsigned int y, int color)
161
{
161
{
162
    (*rgb2scr)(&fbaddress[POINTPOS(x,y)],color);
162
    (*rgb2scr)(&fbaddress[POINTPOS(x,y)],color);
163
 
163
 
164
    if (dbbuffer) {
164
    if (dbbuffer) {
165
        int dline = (y + dboffset) % yres;
165
        int dline = (y + dboffset) % yres;
166
        (*rgb2scr)(&dbbuffer[POINTPOS(x,dline)],color);
166
        (*rgb2scr)(&dbbuffer[POINTPOS(x,dline)],color);
167
    }
167
    }
168
}
168
}
169
 
169
 
170
/** Get pixel from viewport */
170
/** Get pixel from viewport */
171
static int getpixel(unsigned int x, unsigned int y)
171
static int getpixel(unsigned int x, unsigned int y)
172
{
172
{
173
    if (dbbuffer) {
173
    if (dbbuffer) {
174
        int dline = (y + dboffset) % yres;
174
        int dline = (y + dboffset) % yres;
175
        return (*scr2rgb)(&dbbuffer[POINTPOS(x,dline)]);
175
        return (*scr2rgb)(&dbbuffer[POINTPOS(x,dline)]);
176
    }
176
    }
177
    return (*scr2rgb)(&fbaddress[POINTPOS(x,y)]);
177
    return (*scr2rgb)(&fbaddress[POINTPOS(x,y)]);
178
}
178
}
179
 
179
 
180
 
180
 
181
/** Fill screen with background color */
181
/** Fill screen with background color */
182
static void clear_screen(void)
182
static void clear_screen(void)
183
{
183
{
184
    unsigned int y;
184
    unsigned int y;
185
 
185
 
186
    for (y = 0; y < yres; y++) {
186
    for (y = 0; y < yres; y++) {
187
        memcpy(&fbaddress[scanline*y], blankline, xres*pixelbytes);
187
        memcpy(&fbaddress[scanline*y], blankline, xres*pixelbytes);
188
        if (dbbuffer)
188
        if (dbbuffer)
189
            memcpy(&dbbuffer[scanline*y], blankline, xres*pixelbytes);
189
            memcpy(&dbbuffer[scanline*y], blankline, xres*pixelbytes);
190
    }
190
    }
191
}
191
}
192
 
192
 
193
 
193
 
194
/** Scroll screen one row up */
194
/** Scroll screen one row up */
195
static void scroll_screen(void)
195
static void scroll_screen(void)
196
{
196
{
197
    uint8_t *lastline = &fbaddress[(rows - 1) * ROW_BYTES];
197
    uint8_t *lastline = &fbaddress[(rows - 1) * ROW_BYTES];
198
    int firstsz;
198
    int firstsz;
199
 
199
 
200
    if (dbbuffer) {
200
    if (dbbuffer) {
201
        memcpy(&dbbuffer[dboffset*scanline], blankline, FONT_SCANLINES*scanline);
201
        memcpy(&dbbuffer[dboffset*scanline], blankline, FONT_SCANLINES*scanline);
202
       
202
       
203
        dboffset = (dboffset + FONT_SCANLINES) % yres;
203
        dboffset = (dboffset + FONT_SCANLINES) % yres;
204
        firstsz = yres-dboffset;
204
        firstsz = yres-dboffset;
205
 
205
 
206
        memcpy(fbaddress, &dbbuffer[scanline*dboffset], firstsz*scanline);
206
        memcpy(fbaddress, &dbbuffer[scanline*dboffset], firstsz*scanline);
207
        memcpy(&fbaddress[firstsz*scanline], dbbuffer, dboffset*scanline);
207
        memcpy(&fbaddress[firstsz*scanline], dbbuffer, dboffset*scanline);
208
    } else {
208
    } else {
209
        memcpy((void *) fbaddress, (void *) &fbaddress[ROW_BYTES], scanline * yres - ROW_BYTES);
209
        memcpy((void *) fbaddress, (void *) &fbaddress[ROW_BYTES], scanline * yres - ROW_BYTES);
210
        /* Clear last row */
210
        /* Clear last row */
211
        memcpy((void *) lastline, (void *) blankline, ROW_BYTES);
211
        memcpy((void *) lastline, (void *) blankline, ROW_BYTES);
212
    }
212
    }
213
}
213
}
214
 
214
 
215
 
215
 
216
static void invert_pixel(unsigned int x, unsigned int y)
216
static void invert_pixel(unsigned int x, unsigned int y)
217
{
217
{
218
    putpixel(x, y, ~getpixel(x, y));
218
    putpixel(x, y, ~getpixel(x, y));
219
}
219
}
220
 
220
 
221
 
221
 
222
/** Draw one line of glyph at a given position */
222
/** Draw one line of glyph at a given position */
223
static void draw_glyph_line(unsigned int glline, unsigned int x, unsigned int y)
223
static void draw_glyph_line(unsigned int glline, unsigned int x, unsigned int y)
224
{
224
{
225
    unsigned int i;
225
    unsigned int i;
226
 
226
 
227
    for (i = 0; i < 8; i++)
227
    for (i = 0; i < 8; i++)
228
        if (glline & (1 << (7 - i))) {
228
        if (glline & (1 << (7 - i))) {
229
            putpixel(x + i, y, FGCOLOR);
229
            putpixel(x + i, y, FGCOLOR);
230
        } else
230
        } else
231
            putpixel(x + i, y, BGCOLOR);
231
            putpixel(x + i, y, BGCOLOR);
232
}
232
}
233
 
233
 
234
/***************************************************************/
234
/***************************************************************/
235
/* Character-console functions */
235
/* Character-console functions */
236
 
236
 
237
/** Draw character at given position */
237
/** Draw character at given position */
238
static void draw_glyph(uint8_t glyph, unsigned int col, unsigned int row)
238
static void draw_glyph(uint8_t glyph, unsigned int col, unsigned int row)
239
{
239
{
240
    unsigned int y;
240
    unsigned int y;
241
 
241
 
242
    for (y = 0; y < FONT_SCANLINES; y++)
242
    for (y = 0; y < FONT_SCANLINES; y++)
243
        draw_glyph_line(fb_font[glyph * FONT_SCANLINES + y], col * COL_WIDTH, row * FONT_SCANLINES + y);
243
        draw_glyph_line(fb_font[glyph * FONT_SCANLINES + y], col * COL_WIDTH, row * FONT_SCANLINES + y);
244
}
244
}
245
 
245
 
246
/** Invert character at given position */
246
/** Invert character at given position */
247
static void invert_char(unsigned int col, unsigned int row)
247
static void invert_char(unsigned int col, unsigned int row)
248
{
248
{
249
    unsigned int x;
249
    unsigned int x;
250
    unsigned int y;
250
    unsigned int y;
251
 
251
 
252
    for (x = 0; x < COL_WIDTH; x++)
252
    for (x = 0; x < COL_WIDTH; x++)
253
        for (y = 0; y < FONT_SCANLINES; y++)
253
        for (y = 0; y < FONT_SCANLINES; y++)
254
            invert_pixel(col * COL_WIDTH + x, row * FONT_SCANLINES + y);
254
            invert_pixel(col * COL_WIDTH + x, row * FONT_SCANLINES + y);
255
}
255
}
256
 
256
 
257
/** Draw character at default position */
257
/** Draw character at default position */
258
static void draw_char(char chr)
258
static void draw_char(char chr)
259
{
259
{
260
    draw_glyph(chr, position % columns, position / columns);
260
    draw_glyph(chr, position % columns, position / columns);
261
}
261
}
262
 
262
 
263
static void draw_logo(unsigned int startx, unsigned int starty)
263
static void draw_logo(unsigned int startx, unsigned int starty)
264
{
264
{
265
    unsigned int x;
265
    unsigned int x;
266
    unsigned int y;
266
    unsigned int y;
267
    unsigned int byte;
267
    unsigned int byte;
268
    unsigned int rowbytes;
268
    unsigned int rowbytes;
269
 
269
 
270
    rowbytes = (helenos_width - 1) / 8 + 1;
270
    rowbytes = (helenos_width - 1) / 8 + 1;
271
 
271
 
272
    for (y = 0; y < helenos_height; y++)
272
    for (y = 0; y < helenos_height; y++)
273
        for (x = 0; x < helenos_width; x++) {
273
        for (x = 0; x < helenos_width; x++) {
274
            byte = helenos_bits[rowbytes * y + x / 8];
274
            byte = helenos_bits[rowbytes * y + x / 8];
275
            byte >>= x % 8;
275
            byte >>= x % 8;
276
            if (byte & 1)
276
            if (byte & 1)
277
                putpixel(startx + x, starty + y, LOGOCOLOR);
277
                putpixel(startx + x, starty + y, LOGOCOLOR);
278
        }
278
        }
279
}
279
}
280
 
280
 
281
/***************************************************************/
281
/***************************************************************/
282
/* Stdout specific functions */
282
/* Stdout specific functions */
283
 
283
 
284
static void invert_cursor(void)
284
static void invert_cursor(void)
285
{
285
{
286
    invert_char(position % columns, position / columns);
286
    invert_char(position % columns, position / columns);
287
}
287
}
288
 
288
 
289
/** Print character to screen
289
/** Print character to screen
290
 *
290
 *
291
 *  Emulate basic terminal commands
291
 *  Emulate basic terminal commands
292
 */
292
 */
293
static void fb_putchar(chardev_t *dev, char ch)
293
static void fb_putchar(chardev_t *dev, char ch)
294
{
294
{
295
    spinlock_lock(&fb_lock);
295
    spinlock_lock(&fb_lock);
296
   
296
   
297
    switch (ch) {
297
    switch (ch) {
298
        case '\n':
298
        case '\n':
299
            invert_cursor();
299
            invert_cursor();
300
            position += columns;
300
            position += columns;
301
            position -= position % columns;
301
            position -= position % columns;
302
            break;
302
            break;
303
        case '\r':
303
        case '\r':
304
            invert_cursor();
304
            invert_cursor();
305
            position -= position % columns;
305
            position -= position % columns;
306
            break;
306
            break;
307
        case '\b':
307
        case '\b':
308
            invert_cursor();
308
            invert_cursor();
309
            if (position % columns)
309
            if (position % columns)
310
                position--;
310
                position--;
311
            break;
311
            break;
312
        case '\t':
312
        case '\t':
313
            invert_cursor();
313
            invert_cursor();
314
            do {
314
            do {
315
                draw_char(' ');
315
                draw_char(' ');
316
                position++;
316
                position++;
317
            } while ((position % 8) && position < columns * rows);
317
            } while ((position % 8) && position < columns * rows);
318
            break;
318
            break;
319
        default:
319
        default:
320
            draw_char(ch);
320
            draw_char(ch);
321
            position++;
321
            position++;
322
    }
322
    }
323
   
323
   
324
    if (position >= columns * rows) {
324
    if (position >= columns * rows) {
325
        position -= columns;
325
        position -= columns;
326
        scroll_screen();
326
        scroll_screen();
327
    }
327
    }
328
   
328
   
329
    invert_cursor();
329
    invert_cursor();
330
   
330
   
331
    spinlock_unlock(&fb_lock);
331
    spinlock_unlock(&fb_lock);
332
}
332
}
333
 
333
 
334
static chardev_t framebuffer;
334
static chardev_t framebuffer;
335
static chardev_operations_t fb_ops = {
335
static chardev_operations_t fb_ops = {
336
    .write = fb_putchar,
336
    .write = fb_putchar,
337
};
337
};
338
 
338
 
339
 
339
 
340
/** Initialize framebuffer as a chardev output device
340
/** Initialize framebuffer as a chardev output device
341
 *
341
 *
342
 * @param addr  Physical address of the framebuffer
342
 * @param addr  Physical address of the framebuffer
343
 * @param x     Screen width in pixels
343
 * @param x     Screen width in pixels
344
 * @param y     Screen height in pixels
344
 * @param y     Screen height in pixels
345
 * @param bpp   Bits per pixel (8, 16, 24, 32)
345
 * @param bpp   Bits per pixel (8, 16, 24, 32)
346
 * @param scan  Bytes per one scanline
346
 * @param scan  Bytes per one scanline
347
 * @param align Request alignment for 24bpp mode.
347
 * @param align Request alignment for 24bpp mode.
348
 */
348
 */
349
void fb_init(uintptr_t addr, unsigned int x, unsigned int y, unsigned int bpp, unsigned int scan, bool align)
349
void fb_init(uintptr_t addr, unsigned int x, unsigned int y, unsigned int bpp, unsigned int scan, bool align)
350
{
350
{
351
    switch (bpp) {
351
    switch (bpp) {
352
        case 8:
352
        case 8:
353
            rgb2scr = rgb_1byte;
353
            rgb2scr = rgb_1byte;
354
            scr2rgb = byte1_rgb;
354
            scr2rgb = byte1_rgb;
355
            pixelbytes = 1;
355
            pixelbytes = 1;
356
            break;
356
            break;
357
        case 16:
357
        case 16:
358
            rgb2scr = rgb_2byte;
358
            rgb2scr = rgb_2byte;
359
            scr2rgb = byte2_rgb;
359
            scr2rgb = byte2_rgb;
360
            pixelbytes = 2;
360
            pixelbytes = 2;
361
            break;
361
            break;
362
        case 24:
362
        case 24:
363
            rgb2scr = rgb_3byte;
363
            rgb2scr = rgb_3byte;
364
            scr2rgb = byte3_rgb;
364
            scr2rgb = byte3_rgb;
365
            if (align)
365
            if (align)
366
                pixelbytes = 4;
366
                pixelbytes = 4;
367
            else
367
            else
368
                pixelbytes = 3;
368
                pixelbytes = 3;
369
            break;
369
            break;
370
        case 32:
370
        case 32:
371
            rgb2scr = rgb_4byte;
371
            rgb2scr = rgb_4byte;
372
            scr2rgb = byte4_rgb;
372
            scr2rgb = byte4_rgb;
373
            pixelbytes = 4;
373
            pixelbytes = 4;
374
            break;
374
            break;
375
        default:
375
        default:
376
            panic("Unsupported bpp");
376
            panic("Unsupported bpp");
377
    }
377
    }
378
   
378
   
379
    unsigned int fbsize = scan * y;
379
    unsigned int fbsize = scan * y;
380
   
380
   
381
    /* Map the framebuffer */
381
    /* Map the framebuffer */
382
    fbaddress = (uint8_t *) hw_map((uintptr_t) addr, fbsize);
382
    fbaddress = (uint8_t *) hw_map((uintptr_t) addr, fbsize);
383
   
383
   
384
    xres = x;
384
    xres = x;
385
    yres = y;
385
    yres = y;
386
    bitspp = bpp;
386
    bitspp = bpp;
387
    scanline = scan;
387
    scanline = scan;
388
   
388
   
389
    rows = y / FONT_SCANLINES;
389
    rows = y / FONT_SCANLINES;
390
    columns = x / COL_WIDTH;
390
    columns = x / COL_WIDTH;
391
 
391
 
392
    sysinfo_set_item_val("fb", NULL, true);
392
    sysinfo_set_item_val("fb", NULL, true);
393
    sysinfo_set_item_val("fb.kind", NULL, 1);
393
    sysinfo_set_item_val("fb.kind", NULL, 1);
394
    sysinfo_set_item_val("fb.width", NULL, xres);
394
    sysinfo_set_item_val("fb.width", NULL, xres);
395
    sysinfo_set_item_val("fb.height", NULL, yres);
395
    sysinfo_set_item_val("fb.height", NULL, yres);
396
    sysinfo_set_item_val("fb.bpp", NULL, bpp);
396
    sysinfo_set_item_val("fb.bpp", NULL, bpp);
397
    sysinfo_set_item_val("fb.bpp-align", NULL, align);
397
    sysinfo_set_item_val("fb.bpp-align", NULL, align);
398
    sysinfo_set_item_val("fb.scanline", NULL, scan);
398
    sysinfo_set_item_val("fb.scanline", NULL, scan);
399
    sysinfo_set_item_val("fb.address.physical", NULL, addr);
399
    sysinfo_set_item_val("fb.address.physical", NULL, addr);
400
 
400
 
401
    /* Allocate double buffer */
401
    /* Allocate double buffer */
402
    int totsize = scanline * yres;
402
    int totsize = scanline * yres;
403
    int pages = SIZE2FRAMES(totsize);
403
    int pages = SIZE2FRAMES(totsize);
404
    int order;
404
    int order;
405
    if (pages == 1)
405
    if (pages == 1)
406
        order = 0;
406
        order = 0;
407
    else
407
    else
408
        order = fnzb(pages-1)+1;
408
        order = fnzb(pages-1)+1;
409
 
409
 
410
    dbbuffer = frame_alloc(order,FRAME_ATOMIC | FRAME_KA);
410
    dbbuffer = frame_alloc(order,FRAME_ATOMIC | FRAME_KA);
411
    if (!dbbuffer)
411
    if (!dbbuffer)
412
        printf("Failed to allocate scroll buffer.\n");
412
        printf("Failed to allocate scroll buffer.\n");
413
    dboffset = 0;
413
    dboffset = 0;
414
 
414
 
415
    /* Initialized blank line */
415
    /* Initialized blank line */
416
    blankline = (uint8_t *) malloc(ROW_BYTES, FRAME_ATOMIC);
416
    blankline = (uint8_t *) malloc(ROW_BYTES, FRAME_ATOMIC);
417
    if (!blankline)
417
    if (!blankline)
418
        panic("Failed to allocate blank line for framebuffer.");
418
        panic("Failed to allocate blank line for framebuffer.");
419
    for (y=0; y < FONT_SCANLINES; y++)
419
    for (y=0; y < FONT_SCANLINES; y++)
420
        for (x=0; x < xres; x++)
420
        for (x=0; x < xres; x++)
421
            (*rgb2scr)(&blankline[POINTPOS(x,y)],BGCOLOR);
421
            (*rgb2scr)(&blankline[POINTPOS(x,y)],BGCOLOR);
422
 
422
 
423
    clear_screen();
423
    clear_screen();
424
 
424
 
425
    /* Update size of screen to match text area */
425
    /* Update size of screen to match text area */
426
    yres = rows * FONT_SCANLINES;
426
    yres = rows * FONT_SCANLINES;
427
 
427
 
428
    draw_logo(xres - helenos_width, 0);
428
    draw_logo(xres - helenos_width, 0);
429
    invert_cursor();
429
    invert_cursor();
430
 
430
 
431
    chardev_initialize("fb", &framebuffer, &fb_ops);
431
    chardev_initialize("fb", &framebuffer, &fb_ops);
432
    stdout = &framebuffer;
432
    stdout = &framebuffer;
433
   
433
   
434
}
434
}
435
 
435
 
436
/** @}
436
/** @}
437
 */
437
 */
438
 
438