From: Matteo Nastasi <nastasi@alternativeoutput.it>
Date: Wed, 28 Dec 2011 07:52:58 +0000 (+0100)
Subject: first commit
X-Git-Url: http://mop.ddnsfree.com/gitweb/?p=mopice.git;a=commitdiff_plain;h=dcf07fc045d19295fea79ffd9e8ce539d6b00f53

first commit
---

dcf07fc045d19295fea79ffd9e8ce539d6b00f53
diff --git a/greetings.c b/greetings.c
new file mode 100644
index 0000000..1df0d98
--- /dev/null
+++ b/greetings.c
@@ -0,0 +1,28 @@
+#include <stdio.h>
+
+int main_old() {
+    int ret;
+    char val;
+    char *pos = "                                                                                                                                  *";
+    while ((ret = read(0, &val, 1)) > 0) {
+        // printf("%d\n", 64 + (val / 2));
+        printf("%s\n", &(pos[64+(val / 2)]));
+        fflush(stdout);
+    }
+    
+}
+
+int main() {
+    int ret, ival;
+    char val;
+    char *pos = "                                                                                                                                  *";
+    while ((ret = read(0, &val, 1)) > 0) {
+        val = val >> 1;
+        // fprintf(stdout, "%d\n", *(signed char *)(&ival));
+        // val = *(signed char *)(&ival);
+        // fprintf(stdout, "%s\n", &(pos[64+(val/2)]));
+        write(2,&val,1);
+        // fflush(stdout);
+    }
+    
+}
diff --git a/makefile b/makefile
new file mode 100644
index 0000000..b78d6a4
--- /dev/null
+++ b/makefile
@@ -0,0 +1,30 @@
+#
+#  Project mopice
+#
+
+VER=0.0.1
+EXE=mopice showwave greetings
+OBJ=mopice.o
+PKGNAME=mopice
+TARGET=$(EXE)
+
+CC?=gcc
+
+ALL: $(TARGET)
+
+mopice: mopice.c mopice.h
+	$(CC) -g -ggdb -lrt -o $@ $<
+
+showwave: showwave.c
+	$(CC) -g -ggdb -o $@ $<
+
+greetings: greetings.c
+	$(CC) -g -ggdb -o $@ $<
+
+clean:
+	rm -f $(EXE) $(OBJ) *~ $(TARGET)
+
+pkg:
+	tar -zcv --transform="s,^,$(PKGNAME)-$(VER)/,"  -f ../$(PKGNAME)_$(VER).tgz *
+
+.PHONY: clean pkg ALL
diff --git a/mopice.c b/mopice.c
new file mode 100644
index 0000000..f6280cc
--- /dev/null
+++ b/mopice.c
@@ -0,0 +1,334 @@
+/* 
+ *  mopice.c
+ * 
+ *  Copyright (C) 2011 
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ * 
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABLILITY 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 <sys/types.h>
+#include <sys/stat.h>
+#include <sys/ioctl.h>
+#include <fcntl.h>
+#include <string.h>
+#include <time.h>
+#include <errno.h>
+#include <signal.h>
+#include <termios.h>
+
+#include "mopice.h"
+
+/*
+ *  STRUCTURES 
+ */
+
+#define CMD_TYPE_MAND 1
+#define CMD_TYPE_OPT  2
+
+struct cmd {
+    char *snd;
+    char *repl;
+    int wai;
+    int type;
+};
+
+
+/* 
+ *  PROTOTYPES 
+ */
+void alarm_sh(int sig);
+int read_reply(int fh, char *reply, time_t secs);
+int send_cmds(int fh, struct cmd *cmds, int cmds_n);
+
+
+/*
+ *  GLOBALS
+ */
+struct cmd init_cmds[] = {
+    /*      { "\x10!","OK", 3, CMD_TYPE_OPT  } */
+    /*      { "\x10\x18","OK", 3, CMD_TYPE_OPT  }
+            , */ { "ATZ",   "OK", 5, CMD_TYPE_MAND }
+    , { "AT",    "OK\r\n", 3, CMD_TYPE_MAND }
+    , { "ATL1",    "OK\r\n", 3, CMD_TYPE_MAND }
+    , { "ATE1",  "OK\r\n", 3, CMD_TYPE_MAND }
+    , { "ATM2",  "OK\r\n", 3, CMD_TYPE_MAND }
+};
+
+struct cmd answ_cmds[] = {
+    { "AT+FCLASS=8", "OK\r\n", 3, CMD_TYPE_MAND }
+    , { "AT+VLS=1",    "OK\r\n", 3, CMD_TYPE_MAND }
+    /*    , { "AT+VGT=255",  "OK\r\n", 3, CMD_TYPE_MAND } */
+    , { "AT+VTX",    "CONNECT\r\n", 5, CMD_TYPE_MAND }
+};
+
+struct cmd rec_cmds[] = {
+    /* { "ATH1",      "OK", 3, CMD_TYPE_MAND } */
+    { "AT+FCLASS=8", "OK\r\n", 3, CMD_TYPE_MAND }
+    , { "AT+VSD=129,200",  "OK\r\n", 3, CMD_TYPE_MAND }
+    , { "AT+VLS=1",    "OK\r\n", 3, CMD_TYPE_MAND }
+    , { "AT+VRX",    "CONNECT\r\n", 5, CMD_TYPE_MAND }
+};
+
+struct cmd recmsg_cmds[] = {
+    { "\x10\x03","OK\r\n", 3, CMD_TYPE_MAND }
+    , { "AT+VSD=129,200",  "OK\r\n", 3, CMD_TYPE_MAND }
+    , { "AT+VGR=255",  "OK\r\n", 3, CMD_TYPE_MAND }
+    , { "AT+VTD=80",  "OK\r\n", 3, CMD_TYPE_MAND }
+    , { "AT+VTS=[933,0]",  "OK\r\n", 3, CMD_TYPE_MAND }
+    , { "AT+VLS=1",    "OK\r\n", 3, CMD_TYPE_MAND }
+    , { "AT+VRX",    "CONNECT\r\n", 5, CMD_TYPE_MAND }
+};
+
+struct cmd clo_cmds[] = {
+    /* { "\x10\x18","OK", 3, CMD_TYPE_MAND  } */
+    /* { "\x10\x1c","", 3, CMD_TYPE_MAND } */
+      /* , { "\x10!\x10\x18\x10\x03","\x10\x62", 3, CMD_TYPE_MAND }
+         , { "\x10!\x10\x18\x10\x03","\x10\x62", 3, CMD_TYPE_MAND } */
+    { "\x10\x03","OK\r\n", 3, CMD_TYPE_MAND }
+    , { "AT",    "OK\r\n", 3, CMD_TYPE_MAND }
+    , { "AT+FCLASS=0", "OK\r\n", 3, CMD_TYPE_MAND }
+};
+
+int verbose = 0;
+
+
+/*
+ *  FUNCTIONS
+ */
+
+void alarm_sh(int sig)
+{
+    fprintf(stderr, "CATCHED %d\n", sig);
+}
+
+int read_reply(int fh, char *rep, time_t secs)
+{
+    time_t tout;
+    unsigned char bf[1024];
+    int bf_l, ret, i;
+    struct timespec ts;
+
+    if (verbose >= 3) fprintf(stderr, "read_reply::begin\n");
+
+    strcpy(bf,"");
+    bf_l = 0;
+
+    clock_gettime(CLOCK_MONOTONIC, &ts);
+    tout = ts.tv_sec + secs;
+
+    while (1) {
+        clock_gettime(CLOCK_MONOTONIC, &ts);
+        if (ts.tv_sec >= tout) {
+            if (verbose >= 3) fprintf(stderr, "read_reply::end1\n");
+            break;
+        }
+        alarm((unsigned int)secs + 1);
+        if (bf_l == sizeof(bf)) {
+            if (verbose >= 3) fprintf(stderr, "read_reply::end2\n");
+            return (-2);
+        }
+        if (verbose >= 3) fprintf(stderr, "read_reply::pre_read\n");
+        ret = read(fh, &(bf[bf_l]), 512 - bf_l);
+        if (verbose >= 3) fprintf(stderr, "read_reply::post_read %d\n", ret);
+        if (verbose >= 3) {
+            for (i = 0 ; i < ret ; i++) {
+                fprintf(stderr, "xx %02x ", bf[bf_l+i]);
+                if (i % 16 == 15) {
+                    fprintf(stderr, "\n");
+                }
+            }
+            if (i % 16 != 15) 
+                fprintf(stderr, "\n");
+        }
+        if (ret < 0) {
+            if (errno == EINTR) {
+                if (verbose >= 3) fprintf(stderr, "read_reply::end3\n");
+                return (0);
+            }
+            else {
+                if (verbose >= 3) fprintf(stderr, "read_reply::end4\n");
+                return (-1);
+            }
+        }
+        alarm(0);
+        bf[bf_l+ret] = '\0';
+        bf_l = strlen(bf);
+        fprintf(stderr, "bf_l: %d %d %p\n", bf_l, strlen(rep), strstr(bf, rep));
+        if (strstr(bf, rep)) {
+            if (verbose >= 3) fprintf(stderr, "read_reply::end5\n");
+            if (verbose >= 2) fprintf(stderr, "RET: [%s]\n", bf);
+            return (1);
+        }
+    }
+
+    if (verbose >= 3) fprintf(stderr, "read_reply::end6\n");
+    return (0);
+}
+
+int send_cmds(int fh, struct cmd *cmds, int cmds_n)
+{
+    char bf[512];
+    int i, ret;
+
+    if (verbose >= 3) fprintf(stderr, "send_cmds::begin\n");
+
+    for (i = 0 ; i < cmds_n ; i++) {
+        if (verbose >= 2) fprintf(stderr, "send: [%s](%d)\n", cmds[i].snd,strlen(cmds[i].snd));
+        sprintf(bf, "%s\r\n", cmds[i].snd);
+        write(fh, bf, strlen(bf));
+        ret = read_reply(fh, cmds[i].repl, cmds[i].wai);
+        
+        if (verbose >= 3) fprintf(stderr, "send_cmds::read_reply return %d\n", ret);
+        if (ret < 0) {
+            fprintf(stderr, "ERROR: read_reply return %d\n", ret);
+            if (verbose >= 3) fprintf(stderr, "send_cmds::end1\n");
+            return 0;
+        }
+        else if (ret == 0) {
+            if (verbose >= 3) fprintf(stderr, "DE CHE: %d\n", cmds[i].type);
+            if (cmds[i].type == CMD_TYPE_MAND) {
+                if (verbose >= 3) fprintf(stderr, "send_cmds::end2\n");
+                return 0;
+            }
+            else if (cmds[i].type == CMD_TYPE_OPT) {
+                fprintf(stderr, "WARN: on command %d REPLY [%s] NOT ARRIVED\n", i, cmds[i].repl);
+                if (verbose >= 3) fprintf(stderr, "send_cmds::end3\n");
+            }
+        }
+    }
+    
+    if (verbose >= 3) fprintf(stderr, "send_cmds::end4\n");
+    return 1;
+}
+
+#define BAUDRATE B115200
+/*
+ *  MAIN
+ */
+int main(int argc, char *argv[])
+{
+    int fh;
+    FILE *fp;
+    struct termios oldtio,newtio;
+    struct sigaction sa;
+    int i, e, a, n, ret;
+    unsigned char bf[10240], bf2[10240], c;
+
+    struct timespec ts;
+    time_t tout;
+
+    sa.sa_handler = alarm_sh;
+    sigemptyset(&sa.sa_mask);
+    sa.sa_flags = 0;
+    if (sigaction(SIGALRM, &sa, NULL))
+        exit(1);
+
+    if ((fh = open("/dev/ttyS0", O_RDWR | O_NOCTTY)) == -1) {
+        fprintf(stderr, "open failed\n");
+        exit(1);
+    }
+    ioctl( fh, TIOCNOTTY, 0 );
+
+
+    tcgetattr(fh,&oldtio); /* save current serial port settings */
+    bzero(&newtio, sizeof(newtio));
+        newtio.c_cflag = BAUDRATE | CRTSCTS | CS8 | CLOCAL | CREAD;
+        newtio.c_iflag = IGNPAR;
+        newtio.c_oflag = 0;
+        
+        /* set input mode (non-canonical, no echo,...) */
+        newtio.c_lflag = 0;
+         
+        newtio.c_cc[VTIME]    = 0;   /* inter-character timer unused */
+        newtio.c_cc[VMIN]     = 1;   /* blocking read until 5 chars received */
+        
+        tcflush(fh, TCIFLUSH);
+        tcsetattr(fh,TCSANOW,&newtio);
+
+
+    printf("SIZE: %d  NCMD: %d\n", sizeof(init_cmds), sizeof(init_cmds) / sizeof(struct cmd));
+
+    ret = send_cmds(fh, init_cmds, sizeof(init_cmds) / sizeof(struct cmd));
+    fprintf(stderr, "INIT_CMDS: %d\n", ret);
+    
+    a = fgetc(stdin);
+
+#if 0
+    if ((fp = fopen("output.raw", "w")) == NULL) {
+        exit(3);
+    }
+    ret = send_cmds(fh, rec_cmds, sizeof(rec_cmds) / sizeof(struct cmd));
+    fprintf(stderr, "ANSW_CMDS: %d\n", ret);
+
+    while ((ret = read(fh, bf2, 4096)) > 0) {
+        fwrite(bf2, 1, ret, fp);
+        fflush(fp);
+    }
+    
+    exit(123);
+#endif
+
+
+    if ((fp = fopen("greetings.dli", "r")) == NULL) {
+        exit(3);
+    }
+    ret = send_cmds(fh, answ_cmds, sizeof(answ_cmds) / sizeof(struct cmd));
+    fprintf(stderr, "ANSW_CMDS: %d\n", ret);
+
+    while ((ret = fread(bf, 1, 512, fp)) > 0) {
+        for (i = 0, e = 0 ; i < ret ; i++, e++) {
+            if (bf[i] == '\x10') {
+                bf2[e++] = '\x10';
+                bf2[e]   = '\x10';
+                fprintf(stderr, "bf[%u] bf[%u]\n", bf[i], bf[i+1]);
+            }
+            else {
+                bf2[e] = bf[i];
+            }
+        }
+        write(fh, bf2, e);
+    }
+    fclose(fp);
+    
+    ret = send_cmds(fh, recmsg_cmds, sizeof(recmsg_cmds) / sizeof(struct cmd));
+    fprintf(stderr, "RECMSG_CMDS: %d\n", ret);
+    if ((fp = fopen("output_new.raw", "w")) == NULL) {
+        exit(3);
+    }
+    clock_gettime(CLOCK_MONOTONIC, &ts);
+    tout = ts.tv_sec + 10;
+
+    while ((ret = read(fh, bf2, 4096)) > 0) {
+        clock_gettime(CLOCK_MONOTONIC, &ts);
+        if (ts.tv_sec >= tout) {
+            if (verbose >= 3) fprintf(stderr, "read_reply::end1\n");
+            break;
+        }
+        fwrite(bf2, 1, ret, fp);
+        fflush(fp);
+    }
+    fclose(fp);
+
+    ret = send_cmds(fh, clo_cmds, sizeof(clo_cmds) / sizeof(struct cmd));
+    fprintf(stderr, "CLO_CMDS: %d\n", ret);
+
+
+    tcsetattr(fh,TCSANOW,&oldtio);
+
+    close(fh);
+
+    exit (0);
+    return (0);
+}
diff --git a/showwave.c b/showwave.c
new file mode 100644
index 0000000..1df01de
--- /dev/null
+++ b/showwave.c
@@ -0,0 +1,29 @@
+#include <stdio.h>
+
+int main_old() {
+    int ret;
+    char val;
+    char *pos = "                                                                                                                                  *";
+    while ((ret = read(0, &val, 1)) > 0) {
+        // printf("%d\n", 64 + (val / 2));
+        printf("%s\n", &(pos[64+(val / 2)]));
+        fflush(stdout);
+    }
+    
+}
+
+int main() {
+    int ret, ival;
+    char val;
+    char *pos = "                                                                                                                                  *";
+    while ((ret = read(0, &ival, 1)) > 0) {
+        ival = ival << 1;
+        fprintf(stdout, "%d\n", *(signed char *)(&ival));
+        val = *(signed char *)(&ival);
+        val = val / 2;
+        fprintf(stdout, "%s\n", &(pos[64+(val/2)]));
+        write(2,&val,1);
+        fflush(stdout);
+    }
+    
+}