h3600_backpaq_camera.c

pxa270下的摄像头mtd91111的驱动

			buf += width * height;
			to = (streaming ? buf : temp_buf + temp_buf_size);
			WRITE_QVGA_IMAGE(REVERSE,GREY);
		}
		break;
	case VIDEO_PALETTE_YUV422:
		temp_buf_size = width * 2;
		if ( !flipped ) {
			to = (streaming ? buf : temp_buf );
			WRITE_QVGA_IMAGE(FORWARD,YUV);
		}
		else {
			buf += width * height * 2;
			to = (streaming ? buf : temp_buf + temp_buf_size);
			WRITE_QVGA_IMAGE(REVERSE,YUV);
		}
		break;
	}
	return result;
}

static unsigned long write_vga( struct frame *frame, unsigned char *buf, 
				int streaming, int flipped, int palette )
{
	unsigned char *source = frame->data;
	register unsigned char *from;
	int width                    = 640;
	int height                   = 480;
	register int row_width       = frame->width;
	unsigned char temp_buf[640 * 3];
	register unsigned char *to;
	unsigned long           result = 0;
	int                     temp_buf_size;
	register p32            rvalue, gvalue, bvalue, stored_value;

	switch (palette) {
	case VIDEO_PALETTE_RGB24:
		temp_buf_size = width * 3;
		if ( !flipped ) {
			to = (streaming ? buf : temp_buf );
			WRITE_VGA_IMAGE(FORWARD,COLOR);
		}
		else {
			buf += width * height * 3;
			to = (streaming ? buf : temp_buf + temp_buf_size );
			WRITE_VGA_IMAGE(REVERSE,COLOR);
		}
		break;
	case VIDEO_PALETTE_GREY:
		temp_buf_size = width;
		if ( !flipped ) {
			to = (streaming ? buf : temp_buf );
			WRITE_VGA_IMAGE(FORWARD,GREY);
		}
		else {
			buf += width * height;
			to = (streaming ? buf : temp_buf + temp_buf_size );
			WRITE_VGA_IMAGE(REVERSE,GREY);
		}
		break;
	case VIDEO_PALETTE_YUV422:
		temp_buf_size = width * 2;
		if ( !flipped ) {
			to = (streaming ? buf : temp_buf );
			WRITE_VGA_IMAGE(FORWARD,YUV);
		}
		else {
			buf += width * height * 2;
			to = (streaming ? buf : temp_buf + temp_buf_size);
			WRITE_VGA_IMAGE(REVERSE,YUV);
		}
		break;
	}
	return result;
}

/* Routines to handle 5:8 decimation */

/* from, row_width */

#define PR0_0 ((169 *((p32)*(from))+ \
       39 *((p32)*(from+2))+ \
       39 *((p32)*(from+2*row_width))+ \
       9 *((p32)*(from+2*row_width+2))) >> 8)

#define PG0_0 ((25 *((p32)*(from-row_width))+ \
       25 *((p32)*(from-1))+ \
       94 *((p32)*(from+1))+ \
       94 *((p32)*(from+row_width))+ \
       9 *((p32)*(from+row_width+2))+ \
       9 *((p32)*(from+2*row_width+1))) >> 8)

#define PB0_0 ((25 *((p32)*(from-row_width-1))+ \
       55 *((p32)*(from-row_width+1))+ \
       55 *((p32)*(from+row_width-1))+ \
       121 *((p32)*(from+row_width+1))) >> 8)

#define PR1_0 ((26 *((p32)*(from-1))+ \
       169 *((p32)*(from+1))+ \
       13 *((p32)*(from+3))+ \
       6 *((p32)*(from+2*row_width-1))+ \
       39 *((p32)*(from+2*row_width+1))+ \
       3 *((p32)*(from+2*row_width+3))) >> 8)

#define PG1_0 ((25 *((p32)*(from-row_width+1))+ \
       71 *((p32)*(from))+ \
       48 *((p32)*(from+2))+ \
       6 *((p32)*(from+row_width-1))+ \
       94 *((p32)*(from+row_width+1))+ \
       3 *((p32)*(from+row_width+3))+ \
       6 *((p32)*(from+2*row_width))+ \
       3 *((p32)*(from+2*row_width+2))) >> 8)

#define PB1_0 ((45 *((p32)*(from-row_width))+ \
       35 *((p32)*(from-row_width+2))+ \
       99 *((p32)*(from+row_width))+ \
       77 *((p32)*(from+row_width+2))) >> 8)

#define PR2_0 ((13 *((p32)*(from-1))+ \
       39 *((p32)*(from+1))+ \
       3 *((p32)*(from+2*row_width-1))+ \
       9 *((p32)*(from+2*row_width+1))) >> 6)

#define PG2_0 ((5 *((p32)*(from-row_width+1))+ \
       28 *((p32)*(from))+ \
       5 *((p32)*(from+2))+ \
       3 *((p32)*(from+row_width-1))+ \
       20 *((p32)*(from+row_width+1))+ \
       3 *((p32)*(from+2*row_width))) >> 6)

#define PB2_0 ((15 *((p32)*(from-row_width))+ \
       5 *((p32)*(from-row_width+2))+ \
       33 *((p32)*(from+row_width))+ \
       11 *((p32)*(from+row_width+2))) >> 6)

#define PR3_0 ((91 *((p32)*(from))+ \
       117 *((p32)*(from+2))+ \
       21 *((p32)*(from+2*row_width))+ \
       27 *((p32)*(from+2*row_width+2))) >> 8)

#define PG3_0 ((5 *((p32)*(from-row_width))+ \
       10 *((p32)*(from-row_width+2))+ \
       5 *((p32)*(from-1))+ \
       130 *((p32)*(from+1))+ \
       10 *((p32)*(from+3))+ \
       32 *((p32)*(from+row_width))+ \
       49 *((p32)*(from+row_width+2))+ \
       15 *((p32)*(from+2*row_width+1))) >> 8)

#define PB3_0 ((5 *((p32)*(from-row_width-1))+ \
       65 *((p32)*(from-row_width+1))+ \
       10 *((p32)*(from-row_width+3))+ \
       11 *((p32)*(from+row_width-1))+ \
       143 *((p32)*(from+row_width+1))+ \
       22 *((p32)*(from+row_width+3))) >> 8)

#define PR4_0 ((143 *((p32)*(from))+ \
       65 *((p32)*(from+2))+ \
       33 *((p32)*(from+2*row_width))+ \
       15 *((p32)*(from+2*row_width+2))) >> 8)

#define PG4_0 ((15 *((p32)*(from-row_width))+ \
       15 *((p32)*(from-1))+ \
       130 *((p32)*(from+1))+ \
       66 *((p32)*(from+row_width))+ \
       15 *((p32)*(from+row_width+2))+ \
       15 *((p32)*(from+2*row_width+1))) >> 8)

#define PB4_0 ((15 *((p32)*(from-row_width-1))+ \
       65 *((p32)*(from-row_width+1))+ \
       33 *((p32)*(from+row_width-1))+ \
       143 *((p32)*(from+row_width+1))) >> 8)

#define PR0_1 ((26 *((p32)*(from-row_width))+ \
       6 *((p32)*(from-row_width+2))+ \
       169 *((p32)*(from+row_width))+ \
       39 *((p32)*(from+row_width+2))+ \
       13 *((p32)*(from+3*row_width))+ \
       3 *((p32)*(from+3*row_width+2))) >> 8)

#define PG0_1 ((6 *((p32)*(from-row_width+1))+ \
       71 *((p32)*(from))+ \
       6 *((p32)*(from+2))+ \
       25 *((p32)*(from+row_width-1))+ \
       94 *((p32)*(from+row_width+1))+ \
       48 *((p32)*(from+2*row_width))+ \
       3 *((p32)*(from+2*row_width+2))+ \
       3 *((p32)*(from+3*row_width+1))) >> 8)

#define PB0_1 ((45 *((p32)*(from-1))+ \
       99 *((p32)*(from+1))+ \
       35 *((p32)*(from+2*row_width-1))+ \
       77 *((p32)*(from+2*row_width+1))) >> 8)

#define PR1_1 ((4 *((p32)*(from-row_width-1))+ \
       26 *((p32)*(from-row_width+1))+ \
       2 *((p32)*(from-row_width+3))+ \
       26 *((p32)*(from+row_width-1))+ \
       169 *((p32)*(from+row_width+1))+ \
       13 *((p32)*(from+row_width+3))+ \
       2 *((p32)*(from+3*row_width-1))+ \
       13 *((p32)*(from+3*row_width+1))+ \
       ((p32)*(from+3*row_width+3))) >> 8)

#define PG1_1 ((4 *((p32)*(from-row_width))+ \
       2 *((p32)*(from-row_width+2))+ \
       4 *((p32)*(from-1))+ \
       71 *((p32)*(from+1))+ \
       2 *((p32)*(from+3))+ \
       71 *((p32)*(from+row_width))+ \
       48 *((p32)*(from+row_width+2))+ \
       2 *((p32)*(from+2*row_width-1))+ \
       48 *((p32)*(from+2*row_width+1))+ \
       ((p32)*(from+2*row_width+3))+ \
       2 *((p32)*(from+3*row_width))+ \
       ((p32)*(from+3*row_width+2))) >> 8)

#define PB1_1 ((81 *((p32)*(from))+ \
       63 *((p32)*(from+2))+ \
       63 *((p32)*(from+2*row_width))+ \
       49 *((p32)*(from+2*row_width+2))) >> 8)

#define PR2_1 ((2 *((p32)*(from-row_width-1))+ \
       6 *((p32)*(from-row_width+1))+ \
       13 *((p32)*(from+row_width-1))+ \
       39 *((p32)*(from+row_width+1))+ \
       ((p32)*(from+3*row_width-1))+ \
       3 *((p32)*(from+3*row_width+1))) >> 6)

#define PG2_1 ((2 *((p32)*(from-row_width))+ \
       2 *((p32)*(from-1))+ \
       15 *((p32)*(from+1))+ \
       28 *((p32)*(from+row_width))+ \
       5 *((p32)*(from+row_width+2))+ \
       ((p32)*(from+2*row_width-1))+ \
       10 *((p32)*(from+2*row_width+1))+ \
       ((p32)*(from+3*row_width))) >> 6)

#define PB2_1 ((27 *((p32)*(from))+ \
       9 *((p32)*(from+2))+ \
       21 *((p32)*(from+2*row_width))+ \
       7 *((p32)*(from+2*row_width+2))) >> 6)

#define PR3_1 ((14 *((p32)*(from-row_width))+ \
       18 *((p32)*(from-row_width+2))+ \
       91 *((p32)*(from+row_width))+ \
       117 *((p32)*(from+row_width+2))+ \
       7 *((p32)*(from+3*row_width))+ \
       9 *((p32)*(from+3*row_width+2))) >> 8)

#define PG3_1 ((10 *((p32)*(from-row_width+1))+ \
       23 *((p32)*(from))+ \
       36 *((p32)*(from+2))+ \
       5 *((p32)*(from+row_width-1))+ \
       130 *((p32)*(from+row_width+1))+ \
       10 *((p32)*(from+row_width+3))+ \
       14 *((p32)*(from+2*row_width))+ \
       23 *((p32)*(from+2*row_width+2))+ \
       5 *((p32)*(from+3*row_width+1))) >> 8)

#define PB3_1 ((9 *((p32)*(from-1))+ \
       117 *((p32)*(from+1))+ \
       18 *((p32)*(from+3))+ \
       7 *((p32)*(from+2*row_width-1))+ \
       91 *((p32)*(from+2*row_width+1))+ \
       14 *((p32)*(from+2*row_width+3))) >> 8)

#define PR4_1 ((22 *((p32)*(from-row_width))+ \
       10 *((p32)*(from-row_width+2))+ \
       143 *((p32)*(from+row_width))+ \
       65 *((p32)*(from+row_width+2))+ \
       11 *((p32)*(from+3*row_width))+ \
       5 *((p32)*(from+3*row_width+2))) >> 8)

#define PG4_1 ((10 *((p32)*(from-row_width+1))+ \
       49 *((p32)*(from))+ \
       10 *((p32)*(from+2))+ \
       15 *((p32)*(from+row_width-1))+ \
       130 *((p32)*(from+row_width+1))+ \
       32 *((p32)*(from+2*row_width))+ \
       5 *((p32)*(from+2*row_width+2))+ \
       5 *((p32)*(from+3*row_width+1))) >> 8)

#define PB4_1 ((27 *((p32)*(from-1))+ \
       117 *((p32)*(from+1))+ \
       21 *((p32)*(from+2*row_width-1))+ \
       91 *((p32)*(from+2*row_width+1))) >> 8)

#define PR0_2 ((13 *((p32)*(from-row_width))+ \
       3 *((p32)*(from-row_width+2))+ \
       39 *((p32)*(from+row_width))+ \
       9 *((p32)*(from+row_width+2))) >> 6)

#define PG0_2 ((3 *((p32)*(from-row_width+1))+ \
       28 *((p32)*(from))+ \
       3 *((p32)*(from+2))+ \
       5 *((p32)*(from+row_width-1))+ \
       20 *((p32)*(from+row_width+1))+ \
       5 *((p32)*(from+2*row_width))) >> 6)

#define PB0_2 ((15 *((p32)*(from-1))+ \
       33 *((p32)*(from+1))+ \
       5 *((p32)*(from+2*row_width-1))+ \
       11 *((p32)*(from+2*row_width+1))) >> 6)

#define PR1_2 ((2 *((p32)*(from-row_width-1))+ \
       13 *((p32)*(from-row_width+1))+ \
       ((p32)*(from-row_width+3))+ \
       6 *((p32)*(from+row_width-1))+ \
       39 *((p32)*(from+row_width+1))+ \
       3 *((p32)*(from+row_width+3))) >> 6)

#define PG1_2 ((2 *((p32)*(from-row_width))+ \
       ((p32)*(from-row_width+2))+ \
       2 *((p32)*(from-1))+ \
       28 *((p32)*(from+1))+ \
       ((p32)*(from+3))+ \
       15 *((p32)*(from+row_width))+ \
       10 *((p32)*(from+row_width+2))+ \
       5 *((p32)*(from+2*row_width+1))) >> 6)

#define PB1_2 ((27 *((p32)*(from))+ \
       21 *((p32)*(from+2))+ \
       9 *((p32)*(from+2*row_width))+ \
       7 *((p32)*(from+2*row_width+2))) >> 6)

#define PR2_2 ((((p32)*(from-row_width-1))+ \
       3 *((p32)*(from-row_width+1))+ \
       3 *((p32)*(from+row_width-1))+ \
       9 *((p32)*(from+row_width+1))) >> 4)

#define PG2_2 ((((p32)*(from-row_width))+ \
       ((p32)*(from-1))+ \
       6 *((p32)*(from+1))+ \
       6 *((p32)*(from+row_width))+ \
       ((p32)*(from+row_width+2))+ \
       ((p32)*(from+2*row_width+1))) >> 4)

#define PB2_2 ((9 *((p32)*(from))+ \
       3 *((p32)*(from+2))+ \
       3 *((p32)*(from+2*row_width))+ \
       ((p32)*(from+2*row_width+2))) >> 4)

#define PR3_2 ((7 *((p32)*(from-row_width))+ \
       9 *((p32)*(from-row_width+2))+ \
       21 *((p32)*(from+row_width))+ \
       27 *((p32)*(from+row_width+2))) >> 6)

#define PG3_2 ((5 *((p32)*(from-row_width+1))+ \
       10 *((p32)*(from))+ \
       15 *((p32)*(from+2))+ \
       ((p32)*(from+row_width-1))+ \
       28 *((p32)*(from+row_width+1))+ \
       2 *((p32)*(from+row_width+3))+ \
       ((p32)*(from+2*row_width))+ \
       2 *((p32)*(from+2*row_width+2))) >> 6)

#define PB3_2 ((3 *((p32)*(from-1))+ \
       39 *((p32)*(from+1))+ \
       6 *((p32)*(from+3))+ \
       ((p32)*(from+2*row_width-1))+ \
       13 *((p32)*(from+2*row_width+1))+ \
       2 *((p32)*(from+2*row_width+3))) >> 6)

#define PR4_2 ((11 *((p32)*(from-row_width))+ \
       5 *((p32)*(from-row_width+2))+ \
       33 *((p32)*(from+row_width))+ \
       15 *((p32)*(from+row_width+2))) >> 6)

#define PG4_2 ((5 *((p32)*(from-row_width+1))+ \
       20 *((p32)*(from))+ \
       5 *((p32)*(from+2))+ \
       3 *((p32)*(from+row_width-1))+ \
       28 *((p32)*(from+row_width+1))+ \
       3 *((p32)*(from+2*row_width))) >> 6)

#define PB4_2 ((9 *((p32)*(from-1))+ \
       39 *((p32)*(from+1))+ \
       3 *((p32)*(from+2*row_width-1))+ \
       13 *((p32)*(from+2*row_width+1))) >> 6)

#define PR0_3 ((91 *((p32)*(from))+ \
       21 *((p32)*(from+2))+ \
       117 *((p32)*(from+2*row_width))+ \
       27 *((p32)*(from+2*row_width+2))) >> 8)

#define PG0_3 ((5 *((p32)*(from-row_width))+ \
       5 *((p32)*(from-1))+ \
       32 *((p32)*(from+1))+ \
       130 *((p32)*(from+row_width))+ \
       15 *((p32)*(from+row_width+2))+ \
       10 *((p32)*(from+2*row_width-1))+ \
       49 *((p32)*(from+2*row_width+1))+ \
       10 *((p32)*(from+3*row_width))) >> 8)

#define PB0_3 ((5 *((p32)*(from-row_width-1))+ \
       11 *((p32)*(from-row_width+1))+ \
       65 *((p32)*(from+row_width-1))+ \
       143 *((p32)*(from+row_width+1))+ \
       10 *((p32)*(from+3*row_width-1))+ \
       22 *((p32)*(from+3*row_width+1))) >> 8)

#define PR1_3 ((14 *((p32)*(from-1))+ \
       91 *((p32)*(from+1))+ \
       7 *((p32)*(from+3))+ \
       18 *((p32)*(from+2*row_width-1))+ \
       117 *((p32)*(from+2*row_width+1))+ \
       9 *((p32)*(from+2*row_width+3))) >> 8)

#define PG1_3 ((5 *((p32)*(from-row_width+1))+ \
       23 *((p32)*(from))+ \
       14 *((p32)*(from+2))+ \
       10 *((p32)*(from+row_width-1))+ \
       130 *((p32)*(from+row_width+1))+ \
       5 *((p32)*(from+row_width+3))+ \
       36 *((p32)*(from+2*row_width))+ \