FreeCalypso > hg > freecalypso-tools
view uptools/atinterf/fcup-atinterf.c @ 702:36e6a1ff9608
lunadrv: rd and wr commands added
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Thu, 07 May 2020 02:40:13 +0000 |
parents | 13f0fc38cefd |
children |
line wrap: on
line source
#include <sys/types.h> #include <sys/time.h> #include <stdio.h> #include <stdlib.h> #include <string.h> #include <strings.h> #include <termios.h> #include <unistd.h> extern int target_fd; FILE *target_rd; char response[515]; char command[513], message[513]; int cmd_with_msg; read_command_input(buf) char *buf; { char *nl; if (!fgets(buf, 513, stdin)) return(0); nl = index(buf, '\n'); if (!nl) { printf("Ecommand or message is too long\n"); exit(1); } *nl = '\0'; return(1); } send_to_target(cmd, term) char *cmd; { char *endp; int len, cc; endp = index(cmd, '\0'); *endp = term; len = endp - cmd + 1; cc = write(target_fd, cmd, len); *endp = '\0'; if (cc != len) { printf("Etarget write error\n"); exit(1); } } single_char_to_target(ch) { char buf = ch; int cc; cc = write(target_fd, &buf, 1); if (cc != 1) { printf("Etarget write error\n"); exit(1); } } collect_target_response() { char *nl; if (!fgets(response, 515, target_rd)) { printf("Etarget read error\n"); exit(1); } nl = index(response, '\n'); if (!nl) { printf("Etarget response is too long\n"); exit(1); } while (nl > response && nl[-1] == '\r') nl--; *nl = '\0'; } execute_command() { int c; send_to_target(command, '\r'); collect_target_response(); if (strcmp(command, response)) { printf("Efailed to get echo of command\n"); exit(1); } if (cmd_with_msg) { if ((c = getc(target_rd)) != '>') { ungetc(c, target_rd); collect_target_response(); printf("F%s\n", response); return; } if ((c = getc(target_rd)) != ' ') { ungetc(c, target_rd); collect_target_response(); printf("F%s\n", response); return; } send_to_target(message, '\032'); collect_target_response(); if (strcmp(message, response)) { printf("Efailed to get echo of message\n"); exit(1); } } for (;;) { collect_target_response(); if (!strcmp(response, "OK") || !strcmp(response, "ERROR") || !strcmp(response, "BUSY") || !strcmp(response, "NO CARRIER") || !strncmp(response, "+CME ERROR", 10) || !strncmp(response, "+CMS ERROR", 10)) { printf("F%s\n", response); return; } printf("I%s\n", response); } } wakeup_at() { single_char_to_target('A'); usleep(30000); single_char_to_target('T'); usleep(30000); single_char_to_target('\r'); collect_target_response(); if (response[0] && strcmp(response, "AT")) { badresp: printf("Ebad response to wakeup AT command\n"); exit(1); } collect_target_response(); if (strcmp(response, "OK")) goto badresp; } main(argc, argv) char **argv; { int wakeup_after_sec = 7; struct timeval curtime, last_time, timediff; if (argc < 3 || argc > 4) { fprintf(stderr, "usage: %s ttyport baudrate [wakeup-after-sec]\n", argv[0]); exit(1); } open_serial_port(argv[1]); set_fixed_baudrate(argv[2]); if (argc > 3) wakeup_after_sec = strtoul(argv[3], 0, 0); usleep(20000); tcflush(target_fd, TCIFLUSH); set_serial_nonblock(0); target_rd = fdopen(target_fd, "r"); if (!target_rd) { perror("fdopen"); exit(1); } bzero(&last_time, sizeof(struct timeval)); while (read_command_input(command)) { if (!strcasecmp(command, "c+m")) { cmd_with_msg = 1; if (!read_command_input(command)) break; if (!read_command_input(message)) break; } else cmd_with_msg = 0; if (wakeup_after_sec) { gettimeofday(&curtime, 0); timersub(&curtime, &last_time, &timediff); if (timediff.tv_sec >= wakeup_after_sec) wakeup_at(); bcopy(&curtime, &last_time, sizeof(struct timeval)); } execute_command(); fflush(stdout); } exit(0); }