/************************************************************************* * (C) 2011 AITNET - Sofia/Bulgaria - * by Michael Pounov * * $Author: misho $ * $Id: daemon2.c,v 1.3 2012/01/23 10:34:12 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" #include "anshd.h" void * pktTx(sched_task_t *task) { struct tagProc *proc; int wlen; FTRACE(3); /* not found argument, drop data */ if (!(proc = TASK_ARG(task))) return (void*) -1; if ((wlen = pktSend(TASK_FD(task), ++proc->proc_seq, proc->proc_flg, Crypted, proc->proc_buf_[FD2NET], proc->proc_rlen_[FD2NET], &proc->proc_ea)) != ANSH_FLG_ERR) { proc->proc_flg = ANSH_FLG_OK; proc->proc_rlen_[FD2NET] = 0; } VERB(5) LOG("Sended %d bytes", wlen); return NULL; } void * pktRx(sched_task_t *task) { u_char *buf; struct ether_header eth; int rlen, n = 0; struct tagProc *proc = NULL; char ret; u_short *b; u_int seq; FTRACE(3); rlen = bpfLEN; if (!(buf = malloc(rlen))) goto end; else memset(buf, 0, rlen); if ((ret = pktRecv(TASK_FD(task), &seq, &Crypted, buf, &rlen, ð)) == ANSH_FLG_ERR) goto end; VERB(5) LOG("Received %d bytes", rlen); if (!(ret & ANSH_FLG_CPOUT)) goto end; /* packet is ok find active session */ SLIST_FOREACH(proc, &pH, proc_next) if (proc->proc_id == ntohs(eth.ether_type)) { n = ANSH_CODE; break; } /* not found in sessions, drop packet */ if (n != ANSH_CODE) { proc = NULL; goto end; } switch (ret) { case ANSH_FLG_EOF: case ANSH_FLG_CPOUT: if (seq <= proc->proc_seq) goto end; else if (seq > (proc->proc_seq + 1)) LOG("LOST PACKET(s) detect: %d; received seq=%d - %d", seq - proc->proc_seq + 1, seq, proc->proc_seq); proc->proc_seq = seq; break; case ANSH_FLG_WINZ: b = (u_short*) buf; ioChgWinPTY(proc->proc_pty, ntohs(b[0]), ntohs(b[1]), ntohs(b[2]), ntohs(b[3])); /* if not started login, lets start & go! */ if (!proc->proc_pid) { memcpy(&proc->proc_ea, ð.ether_shost, ETHER_ADDR_LEN); spawnLogin(task, proc); } default: goto end; } proc->proc_flg = ret; proc->proc_rlen_[NET2FD] = rlen; memset(proc->proc_buf_[NET2FD], 0, proc->proc_blen); memcpy(proc->proc_buf_[NET2FD], buf, proc->proc_rlen_[NET2FD]); schedWrite(TASK_ROOT(task), fdTx, proc, proc->proc_pty); end: free(buf); schedRead(TASK_ROOT(task), pktRx, NULL, proc ? proc->proc_sock : TASK_FD(task)); return NULL; } void * fdTx(sched_task_t *task) { struct tagProc *proc; struct timeval tv = { 0 }; int wlen; FTRACE(3); /* not found argument, drop data */ if (!(proc = TASK_ARG(task))) return (void*) -1; /* if != ANSH_FLG_CPOUT isnt received from client */ if (proc->proc_flg != ANSH_FLG_CPOUT || !proc->proc_pid) return NULL; /* if Timeout defined, disarm timer */ if (Timeout) schedCancelby(TASK_ROOT(task), &TASK_ROOT(task)->root_timer, CRITERIA_CALL, TOfunc, NULL); wlen = write(TASK_FD(task), proc->proc_buf_[NET2FD], proc->proc_rlen_[NET2FD]); switch (wlen) { case -1: ERR("write2tty #%d - %s", errno, strerror(errno)); /* exit from shell and release tty */ return NULL; default: proc->proc_flg = ANSH_FLG_OK; proc->proc_rlen_[NET2FD] = 0; } VERB(3) LOG("Writed %d bytes - %s", wlen, proc->proc_buf_[NET2FD]); /* if Timeout defined, go arm timer */ if (Timeout) { tv.tv_sec = Timeout; schedTimer(TASK_ROOT(task), TOfunc, proc, tv); } return NULL; } void * fdRx(sched_task_t *task) { struct tagProc *proc; struct timeval tv = { 0 }; int rlen; FTRACE(3); /* not found argument, drop data */ if (!(proc = TASK_ARG(task))) return (void*) -1; if (!proc->proc_pid) return NULL; /* if Timeout defined, disarm timer */ if (Timeout) schedCancelby(TASK_ROOT(task), &TASK_ROOT(task)->root_timer, CRITERIA_CALL, TOfunc, NULL); memset(proc->proc_buf_[FD2NET], 0, proc->proc_blen); rlen = read(TASK_FD(task), proc->proc_buf_[FD2NET], proc->proc_blen - ETHER_HDR_LEN + sizeof(struct ansh_hdr)); switch (rlen) { case -1: ERR("readtty #%d - %s", errno, strerror(errno)); case 0: /* exit from shell and release tty */ return NULL; default: proc->proc_flg = ANSH_FLG_OK; proc->proc_rlen_[FD2NET] = rlen; } VERB(3) LOG("Readed %d bytes - %s", rlen, proc->proc_buf_[FD2NET]); schedCallOnce(TASK_ROOT(task), pktTx, proc, proc->proc_sock); schedRead(TASK_ROOT(task), fdRx, proc, proc->proc_pty); /* if Timeout defined, go arm timer */ if (Timeout) { tv.tv_sec = Timeout; schedTimer(TASK_ROOT(task), TOfunc, proc, tv); } return NULL; } int spawnLogin(sched_task_t *task, struct tagProc *proc) { int flg; struct timeval tv = { 0 }; char str[STRSIZ] = { 0 }; FTRACE(3); assert(proc); switch ((proc->proc_pid = ioForkPTY(&proc->proc_pty, proc->proc_ttyname, sizeof proc->proc_ttyname, NULL, NULL, NULL))) { case -1: ERR("ioForkPTY() #%d - %s", io_GetErrno(), io_GetError()); return -1; case 0: printf("anshd ELWIX remote management system (%s)\n\n", proc->proc_ttyname); strlcpy(str, "-hansh@", sizeof str); io_ether_ntoa((const io_ether_addr_t*) &proc->proc_ea, str + 7, 18); execl("/usr/bin/login", "login", str, NULL); /* never reached */ return -1; default: flg = fcntl(proc->proc_pty, F_GETFL); fcntl(proc->proc_pty, F_SETFL, flg | O_NONBLOCK); VERB(3) LOG("Parent know child pid %d", proc->proc_pid); schedRead(TASK_ROOT(task), fdRx, proc, proc->proc_pty); /* if Timeout defined, go arm timer */ if (Timeout) { tv.tv_sec = Timeout; schedTimer(TASK_ROOT(task), TOfunc, proc, tv); } break; } return 0; }