diff options
Diffstat (limited to 'utils/bcm4751_test.c')
| -rw-r--r-- | utils/bcm4751_test.c | 265 |
1 files changed, 265 insertions, 0 deletions
diff --git a/utils/bcm4751_test.c b/utils/bcm4751_test.c new file mode 100644 index 0000000..bf4159b --- /dev/null +++ b/utils/bcm4751_test.c @@ -0,0 +1,265 @@ +// Copyright (C) 2012 Paul Kocialkowski, contact@paulk.fr, GNU GPLv3+ + +#include <stdio.h> +#include <stdlib.h> +#include <unistd.h> +#include <unistd.h> +#include <termios.h> +#include <errno.h> + +#include <sys/types.h> +#include <sys/stat.h> +#include <fcntl.h> + +#include <sys/syscall.h> +#include <sys/linux-syscalls.h> + +void hex_dump(void *data, int size) +{ + /* dumps size bytes of *data to stdout. Looks like: + * [0000] 75 6E 6B 6E 6F 77 6E 20 + * 30 FF 00 00 00 00 39 00 unknown 0.....9. + * (in a single line of course) + */ + + unsigned char *p = data; + unsigned char c; + int n; + char bytestr[4] = {0}; + char addrstr[10] = {0}; + char hexstr[ 16*3 + 5] = {0}; + char charstr[16*1 + 5] = {0}; + for(n=1;n<=size;n++) { + if (n%16 == 1) { + /* store address for this line */ + snprintf(addrstr, sizeof(addrstr), "%.4x", + ((unsigned int)p-(unsigned int)data) ); + } + + c = *p; + if (isalnum(c) == 0) { + c = '.'; + } + + /* store hex str (for left side) */ + snprintf(bytestr, sizeof(bytestr), "%02X ", *p); + strncat(hexstr, bytestr, sizeof(hexstr)-strlen(hexstr)-1); + + /* store char str (for right side) */ + snprintf(bytestr, sizeof(bytestr), "%c", c); + strncat(charstr, bytestr, sizeof(charstr)-strlen(charstr)-1); + + if(n%16 == 0) { + /* line completed */ + printf("[%4.4s] %-50.50s %s\n", addrstr, hexstr, charstr); + hexstr[0] = 0; + charstr[0] = 0; + } else if(n%8 == 0) { + /* half line: add whitespaces */ + strncat(hexstr, " ", sizeof(hexstr)-strlen(hexstr)-1); + strncat(charstr, " ", sizeof(charstr)-strlen(charstr)-1); + } + p++; /* next byte */ + } + + if (strlen(hexstr) > 0) { + /* print rest of buffer if not empty */ + printf("[%4.4s] %-50.50s %s\n", addrstr, hexstr, charstr); + } +} + +int wake_lock_fd = -1; +int wake_unlock_fd = -1; + +int wake_lock(char *lock_name, int size) +{ + int rc = 0; + + if(wake_lock_fd < 0) + wake_lock_fd = open("/sys/power/wake_lock", O_RDWR); + + rc = write(wake_lock_fd, lock_name, size); + + return rc; +} + +int wake_unlock(char *lock_name, int size) +{ + int rc = 0; + + if(wake_lock_fd < 0) + wake_unlock_fd = open("/sys/power/wake_unlock", O_RDWR); + + rc = write(wake_unlock_fd, lock_name, size); + + return rc; +} + +void gpio_write_ascii(char *gpio_path, char *value) +{ + int fd; + fd = open(gpio_path, O_RDWR); + + if(fd < 0) + return; + + write(fd, value, strlen(value)); + + close(fd); +} + +int main(int argc, char *argv[]) +{ + char *gpio_standby_path = "/sys/class/sec/gps/GPS_PWR_EN/value"; + char *gpio_reset_path = "/sys/class/sec/gps/GPS_nRST/value"; + unsigned char *data; + unsigned char init_val[21]; + int serial_fd; + int rc; + int i; + + struct termios termios; + struct timeval timeout; + int serial; + fd_set fds; + + if(argc > 1) { + if(strcmp(argv[1], "stop") == 0) { + printf("Stopping it\n"); + wake_unlock("gpsd-interface", 14); + gpio_write_ascii(gpio_standby_path, "0\n"); + + return 0; + } + } + + sleep(1); + + printf("Wake lock on gpsd-interface\n"); + + wake_lock("gpsd-interface", 14); + + printf("GPIO 1 write on %s\n", gpio_standby_path); + gpio_write_ascii(gpio_standby_path, "1\n"); + + usleep(250000); + + printf("Opening /dev/s3c2410_serial1\n"); + serial_fd = open("/dev/s3c2410_serial1", O_RDWR|O_NOCTTY|O_NONBLOCK); + + if(serial_fd < 0) { + printf("Serial fd is wrong, aborting\n"); + return 1; + } + + tcgetattr(serial_fd, &termios); + ioctl(serial_fd, TCFLSH, 0x2); + + cfmakeraw(&termios); + cfsetispeed(&termios, B115200); + cfsetospeed(&termios, B115200); + + // This is the magic to contact the chip + termios.c_cflag = 0x800018b2; +// termios.c_cc[5]=0x01; +// termios.c_cc[6]=0x00; + + tcsetattr(serial_fd, TCSANOW, &termios); + ioctl(serial_fd, TCFLSH, 0x2); + tcgetattr(serial_fd, &termios); + + FD_ZERO(&fds); + FD_SET(serial_fd, &fds); + + memset(init_val, 0x80, 21); + data = malloc(512); + + timeout.tv_sec = 1; + timeout.tv_usec = 0; + + printf("Writing init bits\n"); + + rc = select(serial_fd + 1, NULL, &fds, NULL, &timeout); + if(rc > 0) { + write(serial_fd, init_val, 20); + printf("Written\n"); + } else { + printf("Timeout!\n"); + return 0; + } + + for(i=0 ; i < 3 ; i++) { + timeout.tv_sec = 1; + timeout.tv_usec = 0; + + rc = select(serial_fd + 1, &fds, NULL, NULL, &timeout); + + printf("select rc is %d\n", rc); + + if(rc > 0) { + rc = read(serial_fd, data, 512); + printf("read %d bytes!\n", rc); + + if(rc < 0) { + wake_unlock("gpsd-interface", 14); + gpio_write_ascii(gpio_standby_path, "0\n"); + return 0; + } + + hex_dump(data, rc); + break; + } + + write(serial_fd, init_val, 20); + } + + for(i=0 ; i < 3 ; i++) { + rc = read(serial_fd, data, 512); + printf("read %d bytes!\n", rc); + + if(rc < 0) { + perror("Here comes the error"); + } else + hex_dump(data, rc); + + usleep(250000); + } + + wake_unlock("gpsd-interface", 14); + gpio_write_ascii(gpio_standby_path, "0\n"); + + return 0; + + printf("Writing MEIF init bits\n"); + + unsigned char meif_init_bits[9] = { + 0xff, 0x00, 0xfd, 0x40, 0x00, 0x00, 0xe6, 0xfc + }; + + write(serial_fd, meif_init_bits, 8); + + + while(1) { + FD_ZERO(&fds); + FD_SET(serial_fd, &fds); + + timeout.tv_sec = 1; + timeout.tv_usec = 499000; + + rc = select(serial_fd + 1, &fds, NULL, NULL, &timeout); + + printf("select rc is %d\n", rc); + + if(rc > 0) { + rc = read(serial_fd, data, 512); + printf("read %d bytes!\n"); + hex_dump(data, rc); + + // usleep(30000); + } + } + + free(data); + + return 0; +} |