--- ansh/src/client2.c 2011/10/04 22:37:46 1.1.1.1 +++ ansh/src/client2.c 2011/10/13 16:08:52 1.1.1.1.2.4 @@ -3,14 +3,51 @@ * by Michael Pounov * * $Author: misho $ - * $Id: client2.c,v 1.1.1.1 2011/10/04 22:37:46 misho Exp $ + * $Id: client2.c,v 1.1.1.1.2.4 2011/10/13 16:08:52 misho Exp $ * - *************************************************************************/ + ************************************************************************* +The ELWIX and AITNET software is distributed under the following +terms: + +All of the documentation and software included in the ELWIX and AITNET +Releases is copyrighted by ELWIX - Sofia/Bulgaria + +Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011 + by Michael Pounov . All rights reserved. + +Redistribution and use in source and binary forms, with or without +modification, are permitted provided that the following conditions +are met: +1. Redistributions of source code must retain the above copyright + notice, this list of conditions and the following disclaimer. +2. Redistributions in binary form must reproduce the above copyright + notice, this list of conditions and the following disclaimer in the + documentation and/or other materials provided with the distribution. +3. All advertising materials mentioning features or use of this software + must display the following acknowledgement: +This product includes software developed by Michael Pounov +ELWIX - Embedded LightWeight unIX and its contributors. +4. Neither the name of AITNET nor the names of its contributors + may be used to endorse or promote products derived from this software + without specific prior written permission. + +THIS SOFTWARE IS PROVIDED BY AITNET AND CONTRIBUTORS ``AS IS'' AND +ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE +IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE +ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE +FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL +DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS +OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) +HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT +LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY +OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF +SUCH DAMAGE. +*/ #include "global.h" static int -SetRemoteWinz(int h, u_short id, struct ether_addr *ea, u_char *buf, int buflen) +SetRemoteWinz(int h, struct ether_addr *ea, u_char *buf, int buflen) { u_short *pos = (u_short*) buf; struct winsize ws; @@ -27,22 +64,23 @@ SetRemoteWinz(int h, u_short id, struct ether_addr *ea pos[1] = htons(ws.ws_col); pos[2] = htons(ws.ws_xpixel); pos[3] = htons(ws.ws_ypixel); - if (pktSend(h, id, ANSH_FLG_WINZ, buf, sizeof ws, ea) == -1) + if (pktSend(h, 0, ANSH_FLG_WINZ, Crypted, buf, sizeof ws, ea) == -1) return -1; return 0; } int -ConnectL2(int h, u_short id, struct ether_addr *ea, int len) +ConnectL2(int h, struct ether_addr *ea, int len) { fd_set rfd; struct ether_header eth; struct timeval tv = { 10, 0 }; struct termios otio; int rlen, ret = 0; - char flg; - u_char *buf; + char flg, nl = 0; + u_char *buf, *str; + u_int s, Seq = 0; FTRACE(3); @@ -51,7 +89,7 @@ ConnectL2(int h, u_short id, struct ether_addr *ea, in return -1; } - if (SetRemoteWinz(h, id, ea, buf, len) == -1) { + if (SetRemoteWinz(h, ea, buf, len) == -1) { free(buf); return -1; } @@ -62,33 +100,20 @@ ConnectL2(int h, u_short id, struct ether_addr *ea, in FD_ZERO(&rfd); FD_SET(h, &rfd); FD_SET(STDIN_FILENO, &rfd); - if (select(h + 1, &rfd, NULL, NULL, &tv) < 1) { + if (select(h + 1, &rfd, NULL, NULL, (Timeout ? &tv : NULL)) < 1) { ret = -1; break; } - if (FD_ISSET(STDIN_FILENO, &rfd)) { - memset(buf, 0, len); - rlen = read(STDIN_FILENO, buf, len); - if (rlen == -1) { - printf("Error:: read(stdin) #%d - %s\n", errno, strerror(errno)); - ret = -1; - break; - } - rlen = pktSend(h, id, ANSH_FLG_CPOUT, buf, rlen, ea); - if (rlen == ANSH_FLG_ERR) { - ret = -1; - break; - } - } else { + if (FD_ISSET(h, &rfd)) { rlen = len; memset(buf, 0, rlen); - flg = pktRecv(h, buf, &rlen, ð); + flg = pktRecv(h, &s, &Crypted, buf, &rlen, ð); if (flg == ANSH_FLG_ERR) { ret = -1; break; } - if (ntohs(eth.ether_type) != id) { - VERB(4) LOG("different service id %d / %d\n", ntohs(eth.ether_type), id); + if (ntohs(eth.ether_type) != ANSH_ID) { + VERB(4) LOG("different service id %d / %d\n", eth.ether_type, ANSH_ID); continue; } if (flg == ANSH_FLG_EOF) { @@ -97,9 +122,76 @@ ConnectL2(int h, u_short id, struct ether_addr *ea, in } if (flg != ANSH_FLG_OK) continue; + if (s <= Seq) + continue; + else if (s > (Seq + 1)) + VERB(1) LOG("LOST PACKET(s) detect: %d; received seq=%d - %d", + s - (Seq + 1), s, Seq); + Seq = s; + + if (Crypted) { + str = cryptBuffer(buf, rlen, Crypted); + if (str) { + memcpy(buf, str, rlen); + free(str); + } + } + rlen = write(STDOUT_FILENO, buf, rlen); if (rlen == -1) { printf("Error:: write(stdout) #%d - %s\n", errno, strerror(errno)); + ret = -1; + break; + } + } else { + memset(buf, 0, len); + rlen = read(STDIN_FILENO, buf, len); + if (rlen == -1) { + printf("Error:: read(stdin) #%d - %s\n", errno, strerror(errno)); + ret = -1; + break; + } + + /* local command handling */ + if (rlen) { + /* execute local command */ + if (nl == 2) { + switch (*buf) { + case '.': + Kill++; + printf("\n"); + VERB(1) LOG("Exit from client\n"); + continue; + case '~': + default: + nl ^= nl; + /* send buffer, unknown command */ + break; + } + } + /* skip buffer and wait for local command */ + if (nl == 1 && *buf == '~') { + nl++; + continue; + } + /* send buffer if detect NL */ + if (*buf == 0xa || *buf == 0xd) + nl = 1; + else + nl ^= nl; + } else + nl ^= nl; + + if (Crypted) { + str = cryptBuffer(buf, rlen, Crypted); + if (str) { + memcpy(buf, str, rlen); + free(str); + } + } + + rlen = pktSend(h, ++Seq, ANSH_FLG_CPOUT, Crypted, buf, rlen, ea); + if (rlen == ANSH_FLG_ERR) { ret = -1; break; }