WebSVN – HelenOS – Diff – /branches/network/uspace/srv/fb/ppm.c


/*
 * Copyright (c) 2006 Ondrej Palkovsky
 * All rights reserved.
 *
 * 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.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 THE AUTHOR 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 <sys/types.h>
#include <errno.h>
 
#include "ppm.h"
 
static void skip_whitespace(unsigned char **data)
{
retry:
    while (**data == ' ' || **data == '\t' || **data == '\n' ||
        **data == '\r')
        (*data)++;
    if (**data == '#') {
        while (1) {
            if (**data == '\n' || **data == '\r')
                break;
            (*data)++;
        }
        goto retry;
    }
}
 
static void read_num(unsigned char **data, unsigned int *num)
{
    *num = 0;
    while (**data >= '0' && **data <= '9') {
        *num *= 10;
        *num += **data - '0';
        (*data)++;
    }
}
 
int ppm_get_data(unsigned char *data, size_t dtsz, unsigned int *width,
    unsigned int *height)
{
    /* Read magic */
    if (data[0] != 'P' || data[1] != '6')
        return EINVAL;
 
    data+=2;
    skip_whitespace(&data);
    read_num(&data, width);
    skip_whitespace(&data);
    read_num(&data,height);
 
    return 0;
}
 
/** Draw PPM pixmap
 *
 * @param data Pointer to PPM data
 * @param datasz Maximum data size
 * @param sx Coordinate of upper left corner
 * @param sy Coordinate of upper left corner
 * @param maxwidth Maximum allowed width for picture
 * @param maxheight Maximum allowed height for picture
 * @param putpixel Putpixel function used to print bitmap
 */
int ppm_draw(unsigned char *data, size_t datasz, unsigned int sx,
    unsigned int sy, unsigned int maxwidth, unsigned int maxheight,
    putpixel_cb_t putpixel, void *vport)
{
    unsigned int width, height;
    unsigned int maxcolor;
    unsigned int i;
    unsigned int color;
    unsigned int coef;
   
    /* Read magic */
    if ((data[0] != 'P') || (data[1] != '6'))
        return EINVAL;
   
    data += 2;
    skip_whitespace(&data);
    read_num(&data, &width);
    skip_whitespace(&data);
    read_num(&data, &height);
    skip_whitespace(&data);
    read_num(&data, &maxcolor);
    data++;
   
    if ((maxcolor == 0) || (maxcolor > 255) || (width * height > datasz))
        return EINVAL;
   
    coef = 255 / maxcolor;
    if (coef * maxcolor > 255)
        coef -= 1;
   
    for (i = 0; i < width * height; i++) {
        /* Crop picture if we don't fit into region */
        if (i % width > maxwidth || i / width > maxheight) {
            data += 3;
            continue;
        }
        color = ((data[0] * coef) << 16) + ((data[1] * coef) << 8) +
            data[2] * coef;
       
        (*putpixel)(vport, sx + (i % width), sy + (i / width), color);
        data += 3;
    }
   
    return 0;
}
 

Rev 4581	Rev 4718
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	#include <sys/types.h>	29	#include <sys/types.h>
30	#include <errno.h>	30	#include <errno.h>
31		31
32	#include "ppm.h"	32	#include "ppm.h"
33		33
34	static void skip_whitespace(unsigned char **data)	34	static void skip_whitespace(unsigned char **data)
35	{	35	{
36	retry:	36	retry:
37	while (data == ' ' \|\| data == '\t' \|\| **data == '\n' \|\|	37	while (data == ' ' \|\| data == '\t' \|\| **data == '\n' \|\|
38	**data == '\r')	38	**data == '\r')
39	(*data)++;	39	(*data)++;
40	if (**data == '#') {	40	if (**data == '#') {
41	while (1) {	41	while (1) {
42	if (data == '\n' \|\| data == '\r')	42	if (data == '\n' \|\| data == '\r')
43	break;	43	break;
44	(*data)++;	44	(*data)++;
45	}	45	}
46	goto retry;	46	goto retry;
47	}	47	}
48	}	48	}
49		49
50	static void read_num(unsigned char *data, unsigned int num)	50	static void read_num(unsigned char *data, unsigned int num)
51	{	51	{
52	*num = 0;	52	*num = 0;
53	while (data >= '0' && data <= '9') {	53	while (data >= '0' && data <= '9') {
54	num = 10;	54	num = 10;
55	num += *data - '0';	55	num += *data - '0';
56	(*data)++;	56	(*data)++;
57	}	57	}
58	}	58	}
59		59
60	int ppm_get_data(unsigned char data, size_t dtsz, unsigned int width,	60	int ppm_get_data(unsigned char data, size_t dtsz, unsigned int width,
61	unsigned int *height)	61	unsigned int *height)
62	{	62	{
63	/* Read magic */	63	/* Read magic */
64	if (data[0] != 'P' \|\| data[1] != '6')	64	if (data[0] != 'P' \|\| data[1] != '6')
65	return EINVAL;	65	return EINVAL;
66		66
67	data+=2;	67	data+=2;
68	skip_whitespace(&data);	68	skip_whitespace(&data);
69	read_num(&data, width);	69	read_num(&data, width);
70	skip_whitespace(&data);	70	skip_whitespace(&data);
71	read_num(&data,height);	71	read_num(&data,height);
72		72
73	return 0;	73	return 0;
74	}	74	}
75		75
76	/** Draw PPM pixmap	76	/** Draw PPM pixmap
77	*	77	*
78	* @param data Pointer to PPM data	78	* @param data Pointer to PPM data
79	* @param datasz Maximum data size	79	* @param datasz Maximum data size
80	* @param sx Coordinate of upper left corner	80	* @param sx Coordinate of upper left corner
81	* @param sy Coordinate of upper left corner	81	* @param sy Coordinate of upper left corner
82	* @param maxwidth Maximum allowed width for picture	82	* @param maxwidth Maximum allowed width for picture
83	* @param maxheight Maximum allowed height for picture	83	* @param maxheight Maximum allowed height for picture
84	* @param putpixel Putpixel function used to print bitmap	84	* @param putpixel Putpixel function used to print bitmap
85	*/	85	*/
86	int ppm_draw(unsigned char *data, size_t datasz, unsigned int sx,	86	int ppm_draw(unsigned char *data, size_t datasz, unsigned int sx,
87	unsigned int sy, unsigned int maxwidth, unsigned int maxheight,	87	unsigned int sy, unsigned int maxwidth, unsigned int maxheight,
88	putpixel_cb_t putpixel, void *vport)	88	putpixel_cb_t putpixel, void *vport)
89	{	89	{
90	unsigned int width, height;	90	unsigned int width, height;
91	unsigned int maxcolor;	91	unsigned int maxcolor;
92	unsigned i;	92	unsigned int i;
93	unsigned int color;	93	unsigned int color;
94	unsigned int coef;	94	unsigned int coef;
95		95
96	/* Read magic */	96	/* Read magic */
97	if ((data[0] != 'P') \|\| (data[1] != '6'))	97	if ((data[0] != 'P') \|\| (data[1] != '6'))
98	return EINVAL;	98	return EINVAL;
99		99
100	data += 2;	100	data += 2;
101	skip_whitespace(&data);	101	skip_whitespace(&data);
102	read_num(&data, &width);	102	read_num(&data, &width);
103	skip_whitespace(&data);	103	skip_whitespace(&data);
104	read_num(&data, &height);	104	read_num(&data, &height);
105	skip_whitespace(&data);	105	skip_whitespace(&data);
106	read_num(&data, &maxcolor);	106	read_num(&data, &maxcolor);
107	data++;	107	data++;
108		108
109	if ((maxcolor == 0) \|\| (maxcolor > 255) \|\| (width * height > datasz))	109	if ((maxcolor == 0) \|\| (maxcolor > 255) \|\| (width * height > datasz))
110	return EINVAL;	110	return EINVAL;
111		111
112	coef = 255 / maxcolor;	112	coef = 255 / maxcolor;
113	if (coef * maxcolor > 255)	113	if (coef * maxcolor > 255)
114	coef -= 1;	114	coef -= 1;
115		115
116	for (i = 0; i < width * height; i++) {	116	for (i = 0; i < width * height; i++) {
117	/* Crop picture if we don't fit into region */	117	/* Crop picture if we don't fit into region */
118	if (i % width > maxwidth \|\| i / width > maxheight) {	118	if (i % width > maxwidth \|\| i / width > maxheight) {
119	data += 3;	119	data += 3;
120	continue;	120	continue;
121	}	121	}
122	color = ((data[0] * coef) << 16) + ((data[1] * coef) << 8) +	122	color = ((data[0] * coef) << 16) + ((data[1] * coef) << 8) +
123	data[2] * coef;	123	data[2] * coef;
124		124
125	(*putpixel)(vport, sx + (i % width), sy + (i / width), color);	125	(*putpixel)(vport, sx + (i % width), sy + (i / width), color);
126	data += 3;	126	data += 3;
127	}	127	}
128		128
129	return 0;	129	return 0;
130	}	130	}
131		131

Subversion Repositories HelenOS

(root)/branches/network/uspace/srv/fb/ppm.c – Rev 4581 → 4718