Check pixel format.

This commit is contained in:
iabdalkader 2019-03-05 15:38:40 +02:00
parent 7232378692
commit 4c15ce66ca

View File

@ -125,7 +125,7 @@ static int write_reg(sensor_t *sensor, uint8_t reg_addr, uint16_t reg_data)
static int set_pixformat(sensor_t *sensor, pixformat_t pixformat) static int set_pixformat(sensor_t *sensor, pixformat_t pixformat)
{ {
return 0; return ((pixformat != PIXFORMAT_GRAYSCALE) && (pixformat != PIXFORMAT_RGB565)) ? - 1 : 0;
} }
static int set_framesize(sensor_t *sensor, framesize_t framesize) static int set_framesize(sensor_t *sensor, framesize_t framesize)
@ -385,12 +385,12 @@ static int snapshot(sensor_t *sensor, image_t *image, streaming_cb_t streaming_c
MAIN_FB()->h = MAIN_FB()->v; MAIN_FB()->h = MAIN_FB()->v;
switch (sensor->pixformat) { switch (sensor->pixformat) {
case PIXFORMAT_RGB565: { case PIXFORMAT_GRAYSCALE: {
MAIN_FB()->bpp = sizeof(uint16_t); MAIN_FB()->bpp = IMAGE_BPP_GRAYSCALE;
break; break;
} }
case PIXFORMAT_GRAYSCALE: { case PIXFORMAT_RGB565: {
MAIN_FB()->bpp = sizeof(uint8_t); MAIN_FB()->bpp = IMAGE_BPP_RGB565;
break; break;
} }
default: { default: {
@ -433,14 +433,14 @@ static int snapshot(sensor_t *sensor, image_t *image, streaming_cb_t streaming_c
if (v_flip) t_y = MAIN_FB()->v - t_y - 1; if (v_flip) t_y = MAIN_FB()->v - t_y - 1;
switch (sensor->pixformat) { switch (sensor->pixformat) {
case PIXFORMAT_RGB565: {
IMAGE_PUT_RGB565_PIXEL(image, t_x, t_y, rainbow_table[value & 0xFF]);
break;
}
case PIXFORMAT_GRAYSCALE: { case PIXFORMAT_GRAYSCALE: {
IMAGE_PUT_GRAYSCALE_PIXEL(image, t_x, t_y, value & 0xFF); IMAGE_PUT_GRAYSCALE_PIXEL(image, t_x, t_y, value & 0xFF);
break; break;
} }
case PIXFORMAT_RGB565: {
IMAGE_PUT_RGB565_PIXEL(image, t_x, t_y, rainbow_table[value & 0xFF]);
break;
}
default: { default: {
break; break;
} }