source: trunk/software/tty/readtty_power.c @ 10

Last change on this file since 10 was 1, checked in by bouyer, 8 years ago

Initial commit of soc-conso files

File size: 4.9 KB
Line 
1#include <stdio.h>
2#include <stdlib.h>
3#include <unistd.h>
4#include <errno.h>
5#include <fcntl.h>
6#include <signal.h>
7#include <termios.h>
8#include <sys/ioctl.h>
9
10struct scale {
11        float read;
12        float result;
13};
14
15const struct scale *current_scale = NULL;
16const struct scale *voltage_scale = NULL;
17float current_r = 0;
18
19const struct scale current_scale_1 = {3851, 0.5367};
20const float current_r_1 = 0.2;
21const struct scale current_scale_2 = {3651, 0.9761};
22const float current_r_2 = 0.1;
23// const float current_r_3 = 0.05;
24const struct scale voltage_scale_1 = {4041.5, 5.996};
25const struct scale voltage_scale_2 = {4063.5, 13.547};
26const struct scale voltage_scale_3 = {4038, 23.672};
27
28volatile int quit;
29const char *prog;
30
31static void
32set_quit(int s)
33{
34        quit = 1;
35}
36
37static void
38usage()
39{
40        errx(1, "usage: %s -c [1|2] -v [1|2|3] <device>", prog);
41}
42int
43main(int argc, char * const argv[])
44{
45        int d;
46        int bytes;
47        int nfds;
48        char buf[256];
49        int i;
50        fd_set rfds;
51        char gpio[2], current[4], tension[4];
52        char *endp;
53        int currenti, tensioni;
54        float current_a, tension_v;
55        int val;
56        extern char *optarg;
57        extern int optind;
58        int ch;
59        enum {
60                INIT,
61                GPIO,
62                CURRENT,
63                TENSION,
64                MARK
65        } state;
66
67        struct termios t, ot;
68
69        prog = argv[0];
70        state = INIT;
71        currenti = tensioni = 0;
72
73        while ((ch = getopt(argc, argv, "c:v:")) != -1) {
74                switch (ch) {
75                case 'c':
76                        val = atoi(optarg);
77                        if (val == 1) { 
78                                current_scale = &current_scale_1;
79                                current_r = current_r_1;
80                        } else if (val == 2) {
81                                current_scale = &current_scale_2;
82                                current_r = current_r_2;
83                        }
84                        break;
85                case 'v':
86                        val = atoi(optarg);
87                        if (val == 1) { 
88                                voltage_scale = &voltage_scale_1;
89                        } else if (val == 2) {
90                                voltage_scale = &voltage_scale_2;
91                        } else if (val == 3) {
92                                voltage_scale = &voltage_scale_3;
93                        }
94                        break;
95                default: 
96                        usage();
97                }
98        }
99        argc -= optind;
100        argv += optind;
101
102        if (argc != 1 || current_scale == NULL || voltage_scale == NULL) 
103                usage();
104
105        d = open(argv[0], O_RDWR | O_NOCTTY | O_NONBLOCK, 0);
106        if (d < 0) {
107                err(1, "open %s", argv[0]);
108        }
109        fprintf(stderr, "o\n");
110
111        if (tcgetattr(d, &ot) < 0) {
112                err(1, "tcgetattr");
113        }
114        fprintf(stderr, "tg\n");
115
116        quit = 0;
117
118        if (signal(SIGINT, set_quit) == SIG_ERR) {
119                err(1, "signal(SIGINT)");
120        }
121        if (signal(SIGQUIT, set_quit) == SIG_ERR) {
122                err(1, "signal(SIGQUIT)");
123        }
124        if (signal(SIGPIPE, set_quit) == SIG_ERR) {
125                err(1, "signal(SIGPIPE)");
126        }
127        if (signal(SIGTERM, set_quit) == SIG_ERR) {
128                err(1, "signal(SIGTERM)");
129        }
130
131        t = ot;
132        cfmakeraw(&t);
133        t.c_cflag |= CLOCAL;
134        t.c_cflag &= ~CRTSCTS;
135        cfsetspeed(&t, B921600);
136
137        if (tcsetattr(d, TCSANOW | TCSAFLUSH, &t) < 0) {
138                err(1, "tcsetattr");
139        }
140        fprintf(stderr, "tty ready\n");
141        FD_ZERO(&rfds);
142        while (quit == 0) {
143                FD_SET(d, &rfds);
144                nfds = select(d+1, &rfds, NULL, NULL, NULL);
145                if (nfds > 0 && FD_ISSET(d, &rfds)) {
146                        bytes = read(d, buf, sizeof(buf));
147                        if (bytes < 0 && errno != EAGAIN) {
148                                warn("read");
149                        }
150                        for (i = 0; i < bytes; i++) {
151                                switch(state) {
152                                case INIT:
153                                        /* look for an X mark */
154                                        if (buf[i] == 'X')
155                                                state = GPIO;
156                                        break;
157                                case GPIO:
158                                        gpio[0] = buf[i];
159                                        gpio[1] = '\0';
160                                        val = strtol(gpio, &endp, 16);
161                                        if (*endp != '\0') {
162                                                fprintf(stderr,
163                                                    "gpio error: %c\n",
164                                                    *endp);
165                                                state = INIT;
166                                        } else {
167                                                state = TENSION;
168                                                tensioni = 0;
169                                                printf("%2d ", val);
170                                        }
171                                        break;
172                                case CURRENT:
173                                        current[currenti] = buf[i];
174                                        currenti++;
175                                        if (currenti < 3)
176                                                break;
177                                        current[currenti] = '\0';
178                                        val = strtol(current, &endp, 16);
179                                        if (*endp != '\0') {
180                                                fprintf(stderr,
181                                                    "current error: %c\n",
182                                                    *endp);
183                                                state = INIT;
184                                        } else {
185                                                if (val == 4095) {
186                                                        fprintf(stderr,
187                                                          "current saturation\n"
188                                                          );
189                                                }
190                                                state = MARK;
191                                                current_a = val / current_scale->read * current_scale->result;
192                                                printf("%8f ", current_a);
193                                                /* correct for in our resistor */
194                                                tension_v -= current_a * current_r;
195                                                printf("%8f ", tension_v);
196                                                printf("%8f\n", current_a * tension_v);
197                                        }
198                                        break;
199                                case TENSION:
200                                        tension[tensioni] = buf[i];
201                                        tensioni++;
202                                        if (tensioni < 3)
203                                                break;
204                                        tension[tensioni] = '\0';
205                                        val = strtol(tension, &endp, 16);
206                                        if (*endp != '\0') {
207                                                fprintf(stderr,
208                                                    "tension error: %c\n",
209                                                    *endp);
210                                                state = INIT;
211                                        } else {
212                                                if (val == 4095) {
213                                                        fprintf(stderr,
214                                                          "tension saturation\n"
215                                                          );
216                                                }
217                                                state = CURRENT;
218                                                currenti = 0;
219                                                tension_v = val / voltage_scale->read * voltage_scale->result;
220                                        }
221                                        break;
222                                case MARK:
223                                        if (buf[i] != 'X') {
224                                                fprintf(stderr,
225                                                    "mark error: %c\n",
226                                                    buf[i]);
227                                                state = INIT;
228                                        } else {
229                                                state = GPIO;
230                                        }
231                                        break;
232                                }
233                        }
234                } else if (nfds < 0) {
235                        warn("select");
236                }
237        }
238        if (tcsetattr(d, TCSANOW, &ot) < 0) {
239                err(1, "restore tcsetattr");
240        }
241        exit(0);
242}
243
244
Note: See TracBrowser for help on using the repository browser.