void protocol_init(int sock);
-#ifdef HAYES
-int port = -1;
-
-void write_serial(const char* str) {
- const char* ptr = str;
- while(1) {
- if(_bios_serialcom(_COM_STATUS, port, 0) & 0x10) {
- _bios_serialcom(_COM_SEND, port, *ptr);
- ptr++;
- if(*ptr == 0) break;
- }
- }
-}
-
-char* modem_response(void) {
- char* buf = malloc(513);
- buf[0] = 0;
- int count = 0;
- while(1) {
- if(_bios_serialcom(_COM_STATUS, port, 0) & 0x0100) {
- unsigned short b = _bios_serialcom(_COM_RECEIVE, port, 0);
- char ch = b & 0xff;
- if(ch != '\r' && ch != '\n' && ch != 0) {
- buf[count] = ch;
- buf[count + 1] = 0;
- count++;
- } else if(ch == '\r') {
- if(strlen(buf) != 0) break;
- }
- }
- }
- return buf;
-}
-
-int server_init(void) {
- printf("Using Hayes Modem\n");
- int i;
- for(i = 1; i < argc; i++) {
- if(__dw_strcaseequ(argv[i], "COM1")) {
- port = 0;
- } else if(__dw_strcaseequ(argv[i], "COM2")) {
- port = 1;
- } else if(__dw_strcaseequ(argv[i], "COM3")) {
- port = 2;
- } else if(__dw_strcaseequ(argv[i], "COM4")) {
- port = 3;
- } else {
- fprintf(stderr, "Invalid port: %s\n", argv[i]);
- return 1;
- }
- }
- if(port == -1) {
- fprintf(stderr, "Specify serial port\n");
- return 1;
- }
- _bios_serialcom(_COM_INIT, port, _COM_9600 | _COM_NOPARITY | _COM_CHR8 | _COM_STOP1);
- write_serial("AT&FE0F1\r");
- free(modem_response()); /* Kill echo */
- char* resp = modem_response();
- if(__dw_strcaseequ(resp, "OK")) {
- fprintf(stderr, "Modem initialization successful\n");
- } else {
- fprintf(stderr, "Modem initialization fail\n");
- free(resp);
- return 1;
- }
- free(resp);
- return 0;
+bool option(const char* str, const char* shortopt, const char* longopt) {
+ char* dos_shortopt = __dw_strcat("/", shortopt);
+ char* dos_longopt = __dw_strcat("/", longopt);
+ char* nix_shortopt = __dw_strcat("-", shortopt);
+ char* nix_longopt = __dw_strcat("--", longopt);
+ if(__dw_strcaseequ(str, dos_longopt) || __dw_strcaseequ(str, nix_longopt) || strcmp(str, dos_shortopt) == 0 || strcmp(str, nix_shortopt) == 0) return true;
+ return false;
}
-void server_loop(void) {
- bool connected = false;
- while(1) {
- char* resp = modem_response();
- if(__dw_strcaseequ(resp, "NO CARRIER")) {
- free(resp);
- printf("Disconnected\n");
- connected = false;
- continue;
- }
- int i;
- bool has_arg = false;
- for(i = 0; resp[i] != 0; i++) {
- if(resp[i] == ' ') {
- resp[i] = 0;
- has_arg = true;
- break;
- }
- }
- if(connected) {
- } else {
- if(__dw_strcaseequ(resp, "RING")) {
- printf("Got a call, answering\n");
- write_serial("ATA\r");
- } else if(__dw_strcaseequ(resp, "CONNECT")) {
- printf("Connection successful");
- if(has_arg) printf(", %s BPS", resp + i + 1);
- printf("\n");
- printf("Entering connected state\n");
- connected = true;
- protocol_init(0);
- }
- }
- free(resp);
- }
-}
-
-void writeline(int sock, const char* str) {
- char* snd = __dw_strcat(str, "\r\n");
- write_serial(snd);
- free(snd);
-}
-#endif
-
-#ifdef TCPIP
-int port = 4096;
-int server_socket;
-struct sockaddr_in6 server_address;
-
-int server_init(void) {
- printf("Using BSD TCP/IP\n");
- int i;
- for(i = 1; i < argc; i++) {
- port = atoi(argv[i]);
- }
- if((server_socket = socket(AF_INET6, SOCK_STREAM, IPPROTO_TCP)) < 0) {
- fprintf(stderr, "BSD TCP/IP initialization fail\n");
- return 1;
- }
- int yes = 1;
- if(setsockopt(server_socket, SOL_SOCKET, SO_REUSEADDR, &yes, sizeof(yes)) < 0) {
- fprintf(stderr, "BSD TCP/IP initialization fail\n");
- close(server_socket);
- return 1;
- }
- if(setsockopt(server_socket, IPPROTO_TCP, TCP_NODELAY, &yes, sizeof(yes)) < 0) {
- fprintf(stderr, "BSD TCP/IP initialization fail\n");
- close(server_socket);
- return 1;
- }
- int no = 0;
- if(setsockopt(server_socket, IPPROTO_IPV6, IPV6_V6ONLY, &no, sizeof(no)) < 0) {
- fprintf(stderr, "BSD TCP/IP initialization fail\n");
- close(server_socket);
- return 1;
- }
- memset(&server_address, 0, sizeof(server_address));
- server_address.sin6_family = AF_INET6;
- server_address.sin6_addr = in6addr_any;
- server_address.sin6_port = htons(port);
- if(bind(server_socket, (struct sockaddr*)&server_address, sizeof(server_address)) < 0) {
- fprintf(stderr, "BSD TCP/IP initialization fail\n");
- close(server_socket);
- return 1;
- }
- if(listen(server_socket, 128) < 0) {
- fprintf(stderr, "BSD TCP/IP initialization fail\n");
- close(server_socket);
- return 1;
- }
- signal(SIGCHLD, SIG_IGN);
- fprintf(stderr, "BSD TCP/IP initialization successful\n");
- return 0;
-}
-
-void server_loop(void) {
- while(1) {
- struct sockaddr_in claddr;
- int clen = sizeof(claddr);
- int sock = accept(server_socket, (struct sockaddr*)&claddr, &clen);
- pid_t p = fork();
- if(p == 0) {
- protocol_init(sock);
- _exit(0);
- } else {
- close(sock);
- }
- }
-}
-
-void writeline(int sock, const char* str) {
- char* snd = __dw_strcat(str, "\r\n");
- send(sock, snd, strlen(snd), 0);
- free(snd);
-}
-#endif
+int server_init(void);
+void server_loop(void);
+void writeline(int sock, const char* str);
void protocol_init(int sock) {
/* sock is ignored on hayes */
projects / dataworks.git / commitdiff