Mercurial > sdl-ios-xcode
diff src/video/fbcon/SDL_fbelo.c @ 1895:c121d94672cb
SDL 1.2 is moving to a branch, and SDL 1.3 is becoming the head.
author | Sam Lantinga <slouken@libsdl.org> |
---|---|
date | Mon, 10 Jul 2006 21:04:37 +0000 |
parents | d910939febfa |
children | e27bdcc80744 |
line wrap: on
line diff
--- a/src/video/fbcon/SDL_fbelo.c Thu Jul 06 18:01:37 2006 +0000 +++ b/src/video/fbcon/SDL_fbelo.c Mon Jul 10 21:04:37 2006 +0000 @@ -45,16 +45,16 @@ static int ELO_MAX_Y = 3540; #define ELO_SNAP_SIZE 6 -#define ELO_TOUCH_BYTE 'T' +#define ELO_TOUCH_BYTE 'T' #define ELO_ID 'I' #define ELO_MODE 'M' #define ELO_PARAMETER 'P' #define ELO_REPORT 'B' -#define ELO_ACK 'A' +#define ELO_ACK 'A' #define ELO_INIT_CHECKSUM 0xAA -#define ELO_BTN_PRESS 0x01 +#define ELO_BTN_PRESS 0x01 #define ELO_STREAM 0x02 #define ELO_BTN_RELEASE 0x04 @@ -78,365 +78,386 @@ /* eloParsePacket */ -int eloParsePacket(unsigned char* mousebuf, int* dx, int* dy, int* button_state) { - static int elo_button = 0; - static int last_x = 0; - static int last_y = 0; - int x,y; +int +eloParsePacket(unsigned char *mousebuf, int *dx, int *dy, int *button_state) +{ + static int elo_button = 0; + static int last_x = 0; + static int last_y = 0; + int x, y; - /* Check if we have a touch packet */ - if (mousebuf[1] != ELO_TOUCH_BYTE) { - return 0; - } + /* Check if we have a touch packet */ + if (mousebuf[1] != ELO_TOUCH_BYTE) { + return 0; + } - x = ((mousebuf[4] << 8) | mousebuf[3]); - y = ((mousebuf[6] << 8) | mousebuf[5]); + x = ((mousebuf[4] << 8) | mousebuf[3]); + y = ((mousebuf[6] << 8) | mousebuf[5]); - if((SDL_abs(x - last_x) > ELO_SNAP_SIZE) || (SDL_abs(y - last_y) > ELO_SNAP_SIZE)) { - *dx = ((mousebuf[4] << 8) | mousebuf[3]); - *dy = ((mousebuf[6] << 8) | mousebuf[5]); - } - else { - *dx = last_x; - *dy = last_y; - } + if ((SDL_abs(x - last_x) > ELO_SNAP_SIZE) + || (SDL_abs(y - last_y) > ELO_SNAP_SIZE)) { + *dx = ((mousebuf[4] << 8) | mousebuf[3]); + *dy = ((mousebuf[6] << 8) | mousebuf[5]); + } else { + *dx = last_x; + *dy = last_y; + } - last_x = *dx; - last_y = *dy; + last_x = *dx; + last_y = *dy; - if ( (mousebuf[2] & 0x07) == ELO_BTN_PRESS ) { - elo_button = 1; - } - if ( (mousebuf[2] & 0x07) == ELO_BTN_RELEASE ) { - elo_button = 0; - } + if ((mousebuf[2] & 0x07) == ELO_BTN_PRESS) { + elo_button = 1; + } + if ((mousebuf[2] & 0x07) == ELO_BTN_RELEASE) { + elo_button = 0; + } - *button_state = elo_button; - return 1; + *button_state = elo_button; + return 1; } /* Convert the raw coordinates from the ELO controller to a screen position. */ -void eloConvertXY(_THIS, int *dx, int *dy) { - int input_x = *dx; - int input_y = *dy; - int width = ELO_MAX_X - ELO_MIN_X; - int height = ELO_MAX_Y - ELO_MIN_Y; +void +eloConvertXY(_THIS, int *dx, int *dy) +{ + int input_x = *dx; + int input_y = *dy; + int width = ELO_MAX_X - ELO_MIN_X; + int height = ELO_MAX_Y - ELO_MIN_Y; - *dx = ((int)cache_vinfo.xres - ((int)cache_vinfo.xres * (input_x - ELO_MIN_X)) / width); - *dy = (cache_vinfo.yres * (input_y - ELO_MIN_Y)) / height; + *dx = + ((int) cache_vinfo.xres - + ((int) cache_vinfo.xres * (input_x - ELO_MIN_X)) / width); + *dy = (cache_vinfo.yres * (input_y - ELO_MIN_Y)) / height; } /* eloGetPacket */ -int eloGetPacket(unsigned char* buffer, int* buffer_p, int* checksum, int fd) { - int num_bytes; - int ok; +int +eloGetPacket(unsigned char *buffer, int *buffer_p, int *checksum, int fd) +{ + int num_bytes; + int ok; - if(fd == 0) { - num_bytes = ELO_PACKET_SIZE; - } - else { - num_bytes = read(fd, - (char *) (buffer + *buffer_p), - ELO_PACKET_SIZE - *buffer_p); - } + if (fd == 0) { + num_bytes = ELO_PACKET_SIZE; + } else { + num_bytes = read(fd, + (char *) (buffer + *buffer_p), + ELO_PACKET_SIZE - *buffer_p); + } - if (num_bytes < 0) { + if (num_bytes < 0) { #ifdef DEBUG_MOUSE - fprintf(stderr, "System error while reading from Elographics touchscreen.\n"); + fprintf(stderr, + "System error while reading from Elographics touchscreen.\n"); #endif - return 0; - } + return 0; + } - while (num_bytes) { - if ((*buffer_p == 0) && (buffer[0] != ELO_START_BYTE)) { - SDL_memcpy(&buffer[0], &buffer[1], num_bytes-1); - } - else { - if (*buffer_p < ELO_PACKET_SIZE-1) { - *checksum = *checksum + buffer[*buffer_p]; - *checksum = *checksum % 256; - } - (*buffer_p)++; - } - num_bytes--; - } + while (num_bytes) { + if ((*buffer_p == 0) && (buffer[0] != ELO_START_BYTE)) { + SDL_memcpy(&buffer[0], &buffer[1], num_bytes - 1); + } else { + if (*buffer_p < ELO_PACKET_SIZE - 1) { + *checksum = *checksum + buffer[*buffer_p]; + *checksum = *checksum % 256; + } + (*buffer_p)++; + } + num_bytes--; + } - if (*buffer_p == ELO_PACKET_SIZE) { - ok = (*checksum == buffer[ELO_PACKET_SIZE-1]); - *checksum = ELO_INIT_CHECKSUM; - *buffer_p = 0; + if (*buffer_p == ELO_PACKET_SIZE) { + ok = (*checksum == buffer[ELO_PACKET_SIZE - 1]); + *checksum = ELO_INIT_CHECKSUM; + *buffer_p = 0; - if (!ok) { - return 0; - } + if (!ok) { + return 0; + } - return 1; - } - else { - return 0; - } + return 1; + } else { + return 0; + } } /* eloSendPacket */ -int eloSendPacket(unsigned char* packet, int fd) +int +eloSendPacket(unsigned char *packet, int fd) { - int i, result; - int sum = ELO_INIT_CHECKSUM; - - packet[0] = ELO_START_BYTE; - for (i = 0; i < ELO_PACKET_SIZE-1; i++) { - sum += packet[i]; - sum &= 0xFF; - } - packet[ELO_PACKET_SIZE-1] = sum; + int i, result; + int sum = ELO_INIT_CHECKSUM; - result = write(fd, packet, ELO_PACKET_SIZE); + packet[0] = ELO_START_BYTE; + for (i = 0; i < ELO_PACKET_SIZE - 1; i++) { + sum += packet[i]; + sum &= 0xFF; + } + packet[ELO_PACKET_SIZE - 1] = sum; - if (result != ELO_PACKET_SIZE) { + result = write(fd, packet, ELO_PACKET_SIZE); + + if (result != ELO_PACKET_SIZE) { #ifdef DEBUG_MOUSE - printf("System error while sending to Elographics touchscreen.\n"); + printf("System error while sending to Elographics touchscreen.\n"); #endif - return 0; - } - else { - return 1; - } + return 0; + } else { + return 1; + } } /* eloWaitForInput */ -int eloWaitForInput(int fd, int timeout) +int +eloWaitForInput(int fd, int timeout) { - fd_set readfds; - struct timeval to; - int r; + fd_set readfds; + struct timeval to; + int r; - FD_ZERO(&readfds); - FD_SET(fd, &readfds); - to.tv_sec = 0; - to.tv_usec = timeout; + FD_ZERO(&readfds); + FD_SET(fd, &readfds); + to.tv_sec = 0; + to.tv_usec = timeout; - r = select(FD_SETSIZE, &readfds, NULL, NULL, &to); - return r; + r = select(FD_SETSIZE, &readfds, NULL, NULL, &to); + return r; } /* eloWaitReply */ -int eloWaitReply(unsigned char type, unsigned char *reply, int fd) { - int ok; - int i, result; - int reply_p = 0; - int sum = ELO_INIT_CHECKSUM; +int +eloWaitReply(unsigned char type, unsigned char *reply, int fd) +{ + int ok; + int i, result; + int reply_p = 0; + int sum = ELO_INIT_CHECKSUM; - i = ELO_MAX_TRIALS; - do { - ok = 0; + i = ELO_MAX_TRIALS; + do { + ok = 0; - result = eloWaitForInput(fd, ELO_MAX_WAIT); + result = eloWaitForInput(fd, ELO_MAX_WAIT); - if (result > 0) { - ok = eloGetPacket(reply, &reply_p, &sum, fd); + if (result > 0) { + ok = eloGetPacket(reply, &reply_p, &sum, fd); - if (ok && reply[1] != type && type != ELO_PARAMETER) { + if (ok && reply[1] != type && type != ELO_PARAMETER) { #ifdef DEBUG_MOUSE - fprintf(stderr, "Wrong reply received\n"); + fprintf(stderr, "Wrong reply received\n"); #endif - ok = 0; - } - } - else { + ok = 0; + } + } else { #ifdef DEBUG_MOUSE - fprintf(stderr, "No input!\n"); + fprintf(stderr, "No input!\n"); #endif - } + } - if (result == 0) { - i--; - } - } while(!ok && (i>0)); + if (result == 0) { + i--; + } + } + while (!ok && (i > 0)); - return ok; + return ok; } /* eloWaitAck */ -int eloWaitAck(int fd) { - unsigned char packet[ELO_PACKET_SIZE]; - int i, nb_errors; - - if (eloWaitReply(ELO_ACK, packet, fd)) { - for (i = 0, nb_errors = 0; i < 4; i++) { - if (packet[2 + i] != '0') { - nb_errors++; - } - } +int +eloWaitAck(int fd) +{ + unsigned char packet[ELO_PACKET_SIZE]; + int i, nb_errors; - if (nb_errors != 0) { + if (eloWaitReply(ELO_ACK, packet, fd)) { + for (i = 0, nb_errors = 0; i < 4; i++) { + if (packet[2 + i] != '0') { + nb_errors++; + } + } + + if (nb_errors != 0) { #ifdef DEBUG_MOUSE - fprintf(stderr, "Elographics acknowledge packet reports %d errors\n", nb_errors); + fprintf(stderr, + "Elographics acknowledge packet reports %d errors\n", + nb_errors); #endif - } - return 1; - } - else { - return 0; - } + } + return 1; + } else { + return 0; + } } /* eloSendQuery -- */ -int eloSendQuery(unsigned char *request, unsigned char* reply, int fd) { - int ok; +int +eloSendQuery(unsigned char *request, unsigned char *reply, int fd) +{ + int ok; - if (eloSendPacket(request, fd)) { - ok = eloWaitReply(toupper(request[1]), reply, fd); - if (ok) { - ok = eloWaitAck(fd); - } - return ok; - } - else { - return 0; - } + if (eloSendPacket(request, fd)) { + ok = eloWaitReply(toupper(request[1]), reply, fd); + if (ok) { + ok = eloWaitAck(fd); + } + return ok; + } else { + return 0; + } } /* eloSendControl */ -int eloSendControl(unsigned char* control, int fd) { - if (eloSendPacket(control, fd)) { - return eloWaitAck(fd); - } - else { - return 0; - } +int +eloSendControl(unsigned char *control, int fd) +{ + if (eloSendPacket(control, fd)) { + return eloWaitAck(fd); + } else { + return 0; + } } /* eloInitController */ -int eloInitController(int fd) { - unsigned char req[ELO_PACKET_SIZE]; - unsigned char reply[ELO_PACKET_SIZE]; - const char *buffer = NULL; - int result = 0; +int +eloInitController(int fd) +{ + unsigned char req[ELO_PACKET_SIZE]; + unsigned char reply[ELO_PACKET_SIZE]; + const char *buffer = NULL; + int result = 0; - struct termios mouse_termios; + struct termios mouse_termios; - /* try to read the calibration values */ - buffer = SDL_getenv("SDL_ELO_MIN_X"); - if(buffer) { - ELO_MIN_X = SDL_atoi(buffer); - } - buffer = SDL_getenv("SDL_ELO_MAX_X"); - if(buffer) { - ELO_MAX_X = SDL_atoi(buffer); - } - buffer = SDL_getenv("SDL_ELO_MIN_Y"); - if(buffer) { - ELO_MIN_Y = SDL_atoi(buffer); - } - buffer = SDL_getenv("SDL_ELO_MAX_Y"); - if(buffer) { - ELO_MAX_Y = SDL_atoi(buffer); - } - + /* try to read the calibration values */ + buffer = SDL_getenv("SDL_ELO_MIN_X"); + if (buffer) { + ELO_MIN_X = SDL_atoi(buffer); + } + buffer = SDL_getenv("SDL_ELO_MAX_X"); + if (buffer) { + ELO_MAX_X = SDL_atoi(buffer); + } + buffer = SDL_getenv("SDL_ELO_MIN_Y"); + if (buffer) { + ELO_MIN_Y = SDL_atoi(buffer); + } + buffer = SDL_getenv("SDL_ELO_MAX_Y"); + if (buffer) { + ELO_MAX_Y = SDL_atoi(buffer); + } #ifdef DEBUG_MOUSE - fprintf( stderr, "ELO calibration values:\nmin_x: %i\nmax_x: %i\nmin_y: %i\nmax_y: %i\n", - ELO_MIN_X, - ELO_MAX_X, - ELO_MIN_Y, - ELO_MAX_Y); + fprintf(stderr, + "ELO calibration values:\nmin_x: %i\nmax_x: %i\nmin_y: %i\nmax_y: %i\n", + ELO_MIN_X, ELO_MAX_X, ELO_MIN_Y, ELO_MAX_Y); #endif - /* set comm params */ - SDL_memset(&mouse_termios, 0, sizeof(mouse_termios)); - mouse_termios.c_cflag = B9600 | CS8 | CREAD | CLOCAL; - mouse_termios.c_cc[VMIN] = 1; - result = tcsetattr(fd, TCSANOW, &mouse_termios); + /* set comm params */ + SDL_memset(&mouse_termios, 0, sizeof(mouse_termios)); + mouse_termios.c_cflag = B9600 | CS8 | CREAD | CLOCAL; + mouse_termios.c_cc[VMIN] = 1; + result = tcsetattr(fd, TCSANOW, &mouse_termios); - if (result < 0) { + if (result < 0) { #ifdef DEBUG_MOUSE - fprintf( stderr, "Unable to configure Elographics touchscreen port\n"); + fprintf(stderr, "Unable to configure Elographics touchscreen port\n"); #endif - return 0; - } + return 0; + } - SDL_memset(req, 0, ELO_PACKET_SIZE); - req[1] = tolower(ELO_PARAMETER); - if (!eloSendQuery(req, reply, fd)) { + SDL_memset(req, 0, ELO_PACKET_SIZE); + req[1] = tolower(ELO_PARAMETER); + if (!eloSendQuery(req, reply, fd)) { #ifdef DEBUG_MOUSE - fprintf( stderr, "Not at the specified rate or model 2310, will continue\n"); + fprintf(stderr, + "Not at the specified rate or model 2310, will continue\n"); #endif - } + } - SDL_memset(req, 0, ELO_PACKET_SIZE); - req[1] = tolower(ELO_ID); - if (eloSendQuery(req, reply, fd)) { + SDL_memset(req, 0, ELO_PACKET_SIZE); + req[1] = tolower(ELO_ID); + if (eloSendQuery(req, reply, fd)) { #ifdef DEBUG_MOUSE - fprintf(stderr, "Ok, controller configured!\n"); + fprintf(stderr, "Ok, controller configured!\n"); #endif - } - else { + } else { #ifdef DEBUG_MOUSE - fprintf( stderr, "Unable to ask Elographics touchscreen identification\n"); + fprintf(stderr, + "Unable to ask Elographics touchscreen identification\n"); #endif - return 0; - } + return 0; + } - SDL_memset(req, 0, ELO_PACKET_SIZE); - req[1] = ELO_MODE; - req[3] = ELO_TOUCH_MODE | ELO_STREAM_MODE | ELO_UNTOUCH_MODE; - req[4] = ELO_TRACKING_MODE; - if (!eloSendControl(req, fd)) { + SDL_memset(req, 0, ELO_PACKET_SIZE); + req[1] = ELO_MODE; + req[3] = ELO_TOUCH_MODE | ELO_STREAM_MODE | ELO_UNTOUCH_MODE; + req[4] = ELO_TRACKING_MODE; + if (!eloSendControl(req, fd)) { #ifdef DEBUG_MOUSE - fprintf( stderr, "Unable to change Elographics touchscreen operating mode\n"); + fprintf(stderr, + "Unable to change Elographics touchscreen operating mode\n"); #endif - return 0; - } + return 0; + } - SDL_memset(req, 0, ELO_PACKET_SIZE); - req[1] = ELO_REPORT; - req[2] = ELO_UNTOUCH_DELAY; - req[3] = ELO_REPORT_DELAY; - if (!eloSendControl(req, fd)) { + SDL_memset(req, 0, ELO_PACKET_SIZE); + req[1] = ELO_REPORT; + req[2] = ELO_UNTOUCH_DELAY; + req[3] = ELO_REPORT_DELAY; + if (!eloSendControl(req, fd)) { #ifdef DEBUG_MOUSE - fprintf( stderr, "Unable to change Elographics touchscreen reports timings\n"); + fprintf(stderr, + "Unable to change Elographics touchscreen reports timings\n"); #endif - return 0; - } + return 0; + } - return 1; + return 1; } -int eloReadPosition(_THIS, int fd, int* x, int* y, int* button_state, int* realx, int* realy) { - unsigned char buffer[ELO_PACKET_SIZE]; - int pointer = 0; - int checksum = ELO_INIT_CHECKSUM; +int +eloReadPosition(_THIS, int fd, int *x, int *y, int *button_state, int *realx, + int *realy) +{ + unsigned char buffer[ELO_PACKET_SIZE]; + int pointer = 0; + int checksum = ELO_INIT_CHECKSUM; - while(pointer < ELO_PACKET_SIZE) { - if(eloGetPacket(buffer, &pointer, &checksum, fd)) { - break; - } + while (pointer < ELO_PACKET_SIZE) { + if (eloGetPacket(buffer, &pointer, &checksum, fd)) { + break; } + } - if(!eloParsePacket(buffer, realx, realy, button_state)) { - return 0; - } + if (!eloParsePacket(buffer, realx, realy, button_state)) { + return 0; + } + + *x = *realx; + *y = *realy; - *x = *realx; - *y = *realy; + eloConvertXY(this, x, y); - eloConvertXY(this, x, y); - - return 1; + return 1; } + +/* vi: set ts=4 sw=4 expandtab: */