Menu
▾
▴
[Hackndev-commit] SF.net SVN: hackndev: [1015] linux4palm/tools
|
From: <far...@us...> - 2007-05-30 14:39:43
|
Revision: 1015
http://svn.sourceforge.net/hackndev/?rev=1015&view=rev
Author: farcaller
Date: 2007-05-30 07:39:41 -0700 (Wed, 30 May 2007)
Log Message:
-----------
hexterm: Initial import
Added Paths:
-----------
linux4palm/tools/hexterm/
linux4palm/tools/hexterm/Makefile
linux4palm/tools/hexterm/hexterm.c
Added: linux4palm/tools/hexterm/Makefile
===================================================================
--- linux4palm/tools/hexterm/Makefile (rev 0)
+++ linux4palm/tools/hexterm/Makefile 2007-05-30 14:39:41 UTC (rev 1015)
@@ -0,0 +1,7 @@
+all: hexterm
+
+hexterm: hexterm.c
+ $(CC) -g -std=c99 -o hexterm hexterm.c -lreadline
+
+clean:
+ rm -f hexterm *.o
Added: linux4palm/tools/hexterm/hexterm.c
===================================================================
--- linux4palm/tools/hexterm/hexterm.c (rev 0)
+++ linux4palm/tools/hexterm/hexterm.c 2007-05-30 14:39:41 UTC (rev 1015)
@@ -0,0 +1,221 @@
+/*******************************************************************************
+ *
+ * hexterm - stupid hex i/o terminal
+ *
+ * (C) 2007 by Vladimir "Farcaller" Pouzanov <far...@gm...>
+ * Parts of code from bcm-tool by Daniel Ribeiro
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2
+ * as published by the Free Software Foundation
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+ *
+ ******************************************************************************/
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <readline/readline.h>
+#include <readline/history.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <fcntl.h>
+#include <sys/ioctl.h>
+#include <termios.h>
+#include <unistd.h>
+#include <errno.h>
+
+#define MAX_REQUEST 1024
+#define TRUE 1
+#define FALSE 0
+
+/*** parser and console i/o ***/
+
+char parse_char(const char *c)
+{
+ long int i;
+ if(strlen(c)>2)
+ return 0;
+ i = strtol(c, NULL, 16);
+ if(i>255)
+ return 0;
+ return i;
+}
+
+char * parse_line(char *line, int *len)
+{
+ char *p, *s;
+ char b[4];
+ char *buff, *bp;
+ char byte;
+ int done = FALSE;
+ int cnt = 0;
+
+ s = p = line;
+ buff = malloc(MAX_REQUEST);
+ bp = buff;
+ while (*p != '\0' && !done) {
+ while (*p != '\0' && *p != ' ')
+ p++;
+ if (*p == '\0') {
+ done = TRUE;
+ } else {
+ *p = '\0';
+ p++;
+ }
+ strncpy(b, s, 3);
+ b[3] = '\0';
+ byte = parse_char(b);
+ *bp = byte;
+ bp++;
+ cnt++;
+ s = p;
+ }
+ *len = cnt;
+ return buff;
+}
+
+/*** serial i/o ***/
+
+int set_baud(int fd, int baud)
+{
+ struct termios t;
+ char buf[8];
+
+ printf("< set baud: %d\n", baud);
+ tcgetattr(fd, &t);
+ switch (baud) {
+ case 115200:
+ //send_cmd(fd, CMD_SET_BAUD, BAUD115200, 2);
+ cfsetospeed(&t, B115200);
+ break;
+ case 460800:
+ //send_cmd(fd, CMD_SET_BAUD, BAUD460800, 2);
+ cfsetospeed(&t, B460800);
+ break;
+ case 921600:
+ //send_cmd(fd, CMD_SET_BAUD, BAUD921600, 2);
+ cfsetospeed(&t, B921600);
+ break;
+ default:
+ printf ("invalid baud rate!\n");
+ return(-1);
+ }
+ return tcsetattr(fd, TCSANOW, &t);
+}
+
+
+void send_data(int fd, char *bytes, int len)
+{
+ if (len == 0) {
+ printf("==> ...\n");
+ return;
+ }
+ printf("==[%d][", len);
+ char *p;
+ int i;
+ ssize_t sz;
+ sz = write(fd, bytes, len);
+ if (sz == -1) {
+ fprintf(stderr, "write() failed: %d\n", errno);
+ exit(10);
+ }
+ printf("%d]=> ", sz);
+ for(p=bytes, i=0;i<len;i++,p++)
+ printf("%02hhX ", *p);
+ printf("\n");
+
+}
+
+void recv_and_print(int fd)
+{
+ ssize_t sz=0;
+ int cnt = 0;
+ char buf;
+ printf("<== ");
+ while (sz != -1) {
+ sz = read(fd, &buf, 1);
+ if (sz == -1) {
+ if (errno == EAGAIN) {
+ //printf("[%u]==\n", cnt);
+ break;
+ } else {
+ printf("?? %d\n", errno);
+ }
+ return;
+ } else {
+ printf("%02hhX ", buf);
+ cnt++;
+ }
+ }
+
+ printf("[%u]==\n", cnt);
+}
+
+/*** main code ***/
+
+void main_loop(int fd)
+{
+ char *rl = 0;
+ char *bytes;
+ int len;
+ while (TRUE) {
+ rl = readline("> ");
+ if (rl == 0) {
+ return;
+ }
+ add_history(rl);
+ if (strncmp(rl, "baud ", 5) == 0) {
+ long int l;
+ char *p = rl+5;
+ l = atoi(p);
+ set_baud(fd, l);
+ free(rl);
+ rl = 0;
+ continue;
+ }
+ bytes = parse_line(rl, &len);
+ free(rl);
+ rl = 0;
+ send_data(fd, bytes, len);
+ free(bytes);
+ recv_and_print(fd);
+ }
+}
+
+int main(int argc, char *argv[])
+{
+ int fd;
+ struct termios term;
+ if (argc != 2) {
+ fprintf(stderr, "Usage: %s device\n", argv[0]);
+ return 2;
+ }
+ fd = open(argv[1], O_RDWR | O_NOCTTY | O_NONBLOCK);
+ if(fd < 0) {
+ fprintf(stderr, "can't open %s\n", argv[1]);
+ return 1;
+ }
+ printf("< opened %s\n", argv[1]);
+
+ term.c_iflag=0x5;
+ term.c_oflag=0;
+ term.c_cflag=0x1cb2;
+ term.c_lflag=0;
+ term.c_line=0;
+ memcpy(term.c_cc, "\x00\x00\x00\x00\x00\x00\x01\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00", NCCS);
+ ioctl (fd, TCSETS, &term);
+ printf("< configured port\n");
+ main_loop(fd);
+ close(fd);
+ return 0;
+}
+
This was sent by the SourceForge.net collaborative development platform, the world's largest Open Source development site.
|
