version 1.1.1.1.2.1, 2011/10/10 09:11:48
|
version 1.3.2.1, 2012/01/23 16:13:07
|
Line 5
|
Line 5
|
* $Author$ |
* $Author$ |
* $Id$ |
* $Id$ |
* |
* |
*************************************************************************/ | ************************************************************************* |
| 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 <info@elwix.org> |
| |
| Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011 |
| by Michael Pounov <misho@elwix.org>. 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 <misho@elwix.org> |
| 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 "global.h" |
#include "anshd.h" |
#include "anshd.h" |
|
|
Line 15 pktTx(sched_task_t *task)
|
Line 52 pktTx(sched_task_t *task)
|
{ |
{ |
struct tagProc *proc; |
struct tagProc *proc; |
int wlen; |
int wlen; |
u_char *str; |
|
|
|
FTRACE(3); |
FTRACE(3); |
|
|
Line 23 pktTx(sched_task_t *task)
|
Line 59 pktTx(sched_task_t *task)
|
if (!(proc = TASK_ARG(task))) |
if (!(proc = TASK_ARG(task))) |
return (void*) -1; |
return (void*) -1; |
|
|
if (Crypted) { | if ((wlen = pktSend(TASK_FD(task), ++proc->proc_seq, proc->proc_flg, Crypted, |
str = cryptBuffer(proc->proc_buf_[FD2NET], proc->proc_rlen_[FD2NET], Crypted); | proc->proc_buf_[FD2NET], proc->proc_rlen_[FD2NET], |
if (str) { | &proc->proc_ea)) != ANSH_FLG_ERR) { |
memcpy(proc->proc_buf_[FD2NET], str, proc->proc_rlen_[FD2NET]); | |
free(str); | |
} | |
} | |
| |
if ((wlen = pktSend(TASK_FD(task), proc->proc_id, 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_flg = ANSH_FLG_OK; |
proc->proc_rlen_[FD2NET] = 0; |
proc->proc_rlen_[FD2NET] = 0; |
} |
} |
Line 44 pktTx(sched_task_t *task)
|
Line 73 pktTx(sched_task_t *task)
|
void * |
void * |
pktRx(sched_task_t *task) |
pktRx(sched_task_t *task) |
{ |
{ |
u_char *buf, *str; | u_char *buf; |
struct ether_header eth; |
struct ether_header eth; |
int rlen, n = 0; |
int rlen, n = 0; |
struct tagProc *proc = NULL; |
struct tagProc *proc = NULL; |
char ret; |
char ret; |
u_short *b; |
u_short *b; |
|
u_int seq; |
|
|
FTRACE(3); |
FTRACE(3); |
|
|
rlen = bpfLEN; |
rlen = bpfLEN; |
if (!(buf = malloc(rlen))) |
if (!(buf = malloc(rlen))) |
goto end; |
goto end; |
|
else |
|
memset(buf, 0, rlen); |
|
|
if ((ret = pktRecv(TASK_FD(task), &Crypted, buf, &rlen, ð)) == ANSH_FLG_ERR) | if ((ret = pktRecv(TASK_FD(task), &seq, &Crypted, buf, &rlen, ð)) == ANSH_FLG_ERR) |
goto end; |
goto end; |
VERB(5) LOG("Received %d bytes", rlen); |
VERB(5) LOG("Received %d bytes", rlen); |
if (!(ret & ANSH_FLG_CPOUT)) |
if (!(ret & ANSH_FLG_CPOUT)) |
Line 75 pktRx(sched_task_t *task)
|
Line 107 pktRx(sched_task_t *task)
|
goto end; |
goto end; |
} |
} |
|
|
if (Crypted) { |
|
str = cryptBuffer(buf, rlen, Crypted); |
|
if (str) { |
|
memcpy(buf, str, rlen); |
|
free(str); |
|
} |
|
} |
|
|
|
switch (ret) { |
switch (ret) { |
case ANSH_FLG_EOF: |
case ANSH_FLG_EOF: |
case ANSH_FLG_CPOUT: |
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; |
break; |
case ANSH_FLG_WINZ: |
case ANSH_FLG_WINZ: |
b = (u_short*) buf; |
b = (u_short*) buf; |
ioChgWinPTY(proc->proc_pty, ntohs(b[0]), ntohs(b[1]), ntohs(b[2]), ntohs(b[3])); |
ioChgWinPTY(proc->proc_pty, ntohs(b[0]), ntohs(b[1]), ntohs(b[2]), ntohs(b[3])); |
/* if not started login, lets start & go! */ |
/* if not started login, lets start & go! */ |
if (!proc->proc_pid) { |
if (!proc->proc_pid) { |
memcpy(&proc->proc_ea.octet, ð.ether_shost, ETHER_ADDR_LEN); | memcpy(&proc->proc_ea, ð.ether_shost, ETHER_ADDR_LEN); |
spawnLogin(task, proc); |
spawnLogin(task, proc); |
} |
} |
default: |
default: |
Line 103 pktRx(sched_task_t *task)
|
Line 133 pktRx(sched_task_t *task)
|
proc->proc_rlen_[NET2FD] = rlen; |
proc->proc_rlen_[NET2FD] = rlen; |
memset(proc->proc_buf_[NET2FD], 0, proc->proc_blen); |
memset(proc->proc_buf_[NET2FD], 0, proc->proc_blen); |
memcpy(proc->proc_buf_[NET2FD], buf, proc->proc_rlen_[NET2FD]); |
memcpy(proc->proc_buf_[NET2FD], buf, proc->proc_rlen_[NET2FD]); |
schedWrite(TASK_ROOT(task), fdTx, proc, proc->proc_pty); | schedWrite(TASK_ROOT(task), fdTx, proc, proc->proc_pty, NULL, 0); |
end: |
end: |
free(buf); |
free(buf); |
schedRead(TASK_ROOT(task), pktRx, NULL, proc ? proc->proc_sock : TASK_FD(task)); | schedRead(TASK_ROOT(task), pktRx, NULL, proc ? proc->proc_sock : TASK_FD(task), NULL, 0); |
return NULL; |
return NULL; |
} |
} |
|
|
Line 127 fdTx(sched_task_t *task)
|
Line 157 fdTx(sched_task_t *task)
|
if (proc->proc_flg != ANSH_FLG_CPOUT || !proc->proc_pid) |
if (proc->proc_flg != ANSH_FLG_CPOUT || !proc->proc_pid) |
return NULL; |
return NULL; |
|
|
if (waitpid(proc->proc_pid, &wlen, WNOHANG)) { |
|
ioFreePTY(TASK_FD(task), proc->proc_ttyname); |
|
schedCancelby(TASK_ROOT(task), NULL, CRITERIA_FD, (void*) TASK_FD(task), NULL); |
|
|
|
proc->proc_pid = 0; |
|
proc->proc_flg = ANSH_FLG_EOF; |
|
proc->proc_rlen_[FD2NET] = 0; |
|
|
|
schedWrite(TASK_ROOT(task), pktTx, proc, proc->proc_sock); |
|
return NULL; |
|
} |
|
|
|
/* if Timeout defined, disarm timer */ |
/* if Timeout defined, disarm timer */ |
if (Timeout) |
if (Timeout) |
schedCancelby(TASK_ROOT(task), &TASK_ROOT(task)->root_timer, CRITERIA_CALL, TOfunc, NULL); | schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_CALL, TOfunc, NULL); |
|
|
wlen = write(TASK_FD(task), proc->proc_buf_[NET2FD], proc->proc_rlen_[NET2FD]); |
wlen = write(TASK_FD(task), proc->proc_buf_[NET2FD], proc->proc_rlen_[NET2FD]); |
switch (wlen) { |
switch (wlen) { |
case -1: |
case -1: |
ERR("write2tty #%d - %s", errno, strerror(errno)); |
ERR("write2tty #%d - %s", errno, strerror(errno)); |
/* exit from shell and release tty */ |
/* exit from shell and release tty */ |
waitpid(proc->proc_pid, &wlen, 0); |
|
ioFreePTY(TASK_FD(task), proc->proc_ttyname); |
|
schedCancelby(TASK_ROOT(task), NULL, CRITERIA_FD, (void*) TASK_FD(task), NULL); |
|
|
|
proc->proc_pid = 0; |
|
proc->proc_flg = ANSH_FLG_EOF; |
|
proc->proc_rlen_[FD2NET] = 0; |
|
|
|
schedWrite(TASK_ROOT(task), pktTx, proc, proc->proc_sock); |
|
return NULL; |
return NULL; |
default: |
default: |
proc->proc_flg = ANSH_FLG_OK; |
proc->proc_flg = ANSH_FLG_OK; |
Line 167 fdTx(sched_task_t *task)
|
Line 176 fdTx(sched_task_t *task)
|
/* if Timeout defined, go arm timer */ |
/* if Timeout defined, go arm timer */ |
if (Timeout) { |
if (Timeout) { |
tv.tv_sec = Timeout; |
tv.tv_sec = Timeout; |
schedTimer(TASK_ROOT(task), TOfunc, proc, tv); | schedTimer(TASK_ROOT(task), TOfunc, proc, tv, NULL, 0); |
} |
} |
return NULL; |
return NULL; |
} |
} |
Line 187 fdRx(sched_task_t *task)
|
Line 196 fdRx(sched_task_t *task)
|
if (!proc->proc_pid) |
if (!proc->proc_pid) |
return NULL; |
return NULL; |
|
|
if (waitpid(proc->proc_pid, &rlen, WNOHANG)) { |
|
ioFreePTY(TASK_FD(task), proc->proc_ttyname); |
|
schedCancelby(TASK_ROOT(task), NULL, CRITERIA_FD, (void*) TASK_FD(task), NULL); |
|
|
|
proc->proc_pid = 0; |
|
proc->proc_flg = ANSH_FLG_EOF; |
|
proc->proc_rlen_[FD2NET] = 0; |
|
|
|
schedWrite(TASK_ROOT(task), pktTx, proc, proc->proc_sock); |
|
return NULL; |
|
} |
|
|
|
/* if Timeout defined, disarm timer */ |
/* if Timeout defined, disarm timer */ |
if (Timeout) |
if (Timeout) |
schedCancelby(TASK_ROOT(task), &TASK_ROOT(task)->root_timer, CRITERIA_CALL, TOfunc, NULL); | schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_CALL, TOfunc, NULL); |
|
|
memset(proc->proc_buf_[FD2NET], 0, proc->proc_blen); |
memset(proc->proc_buf_[FD2NET], 0, proc->proc_blen); |
rlen = read(TASK_FD(task), proc->proc_buf_[FD2NET], proc->proc_blen); | rlen = read(TASK_FD(task), proc->proc_buf_[FD2NET], |
| proc->proc_blen - ETHER_HDR_LEN + sizeof(struct ansh_hdr)); |
switch (rlen) { |
switch (rlen) { |
case -1: |
case -1: |
ERR("readtty #%d - %s", errno, strerror(errno)); |
ERR("readtty #%d - %s", errno, strerror(errno)); |
case 0: |
case 0: |
/* exit from shell and release tty */ |
/* exit from shell and release tty */ |
waitpid(proc->proc_pid, &rlen, 0); |
|
ioFreePTY(TASK_FD(task), proc->proc_ttyname); |
|
schedCancelby(TASK_ROOT(task), NULL, CRITERIA_FD, (void*) TASK_FD(task), NULL); |
|
VERB(3) LOG("EOF process status %d", rlen); |
|
|
|
proc->proc_pid = 0; |
|
proc->proc_flg = ANSH_FLG_EOF; |
|
proc->proc_rlen_[FD2NET] = 0; |
|
|
|
schedWrite(TASK_ROOT(task), pktTx, proc, proc->proc_sock); |
|
return NULL; |
return NULL; |
default: |
default: |
proc->proc_flg = ANSH_FLG_OK; |
proc->proc_flg = ANSH_FLG_OK; |
Line 227 fdRx(sched_task_t *task)
|
Line 215 fdRx(sched_task_t *task)
|
} |
} |
VERB(3) LOG("Readed %d bytes - %s", rlen, proc->proc_buf_[FD2NET]); |
VERB(3) LOG("Readed %d bytes - %s", rlen, proc->proc_buf_[FD2NET]); |
|
|
schedWrite(TASK_ROOT(task), pktTx, proc, proc->proc_sock); | schedCallOnce(TASK_ROOT(task), pktTx, proc, proc->proc_sock, NULL, 0); |
schedRead(TASK_ROOT(task), fdRx, proc, proc->proc_pty); | schedRead(TASK_ROOT(task), fdRx, proc, proc->proc_pty, NULL, 0); |
|
|
/* if Timeout defined, go arm timer */ |
/* if Timeout defined, go arm timer */ |
if (Timeout) { |
if (Timeout) { |
tv.tv_sec = Timeout; |
tv.tv_sec = Timeout; |
schedTimer(TASK_ROOT(task), TOfunc, proc, tv); | schedTimer(TASK_ROOT(task), TOfunc, proc, tv, NULL, 0); |
} |
} |
return NULL; |
return NULL; |
} |
} |
Line 257 spawnLogin(sched_task_t *task, struct tagProc *proc)
|
Line 245 spawnLogin(sched_task_t *task, struct tagProc *proc)
|
case 0: |
case 0: |
printf("anshd ELWIX remote management system (%s)\n\n", proc->proc_ttyname); |
printf("anshd ELWIX remote management system (%s)\n\n", proc->proc_ttyname); |
strlcpy(str, "-hansh@", sizeof str); |
strlcpy(str, "-hansh@", sizeof str); |
ether_ntoa_r(&proc->proc_ea, str + 7); | io_ether_ntoa((const io_ether_addr_t*) &proc->proc_ea, str + 7, 18); |
|
|
execl("/usr/bin/login", "login", str, NULL); |
execl("/usr/bin/login", "login", str, NULL); |
/* never reached */ |
/* never reached */ |
Line 267 spawnLogin(sched_task_t *task, struct tagProc *proc)
|
Line 255 spawnLogin(sched_task_t *task, struct tagProc *proc)
|
fcntl(proc->proc_pty, F_SETFL, flg | O_NONBLOCK); |
fcntl(proc->proc_pty, F_SETFL, flg | O_NONBLOCK); |
|
|
VERB(3) LOG("Parent know child pid %d", proc->proc_pid); |
VERB(3) LOG("Parent know child pid %d", proc->proc_pid); |
schedRead(TASK_ROOT(task), fdRx, proc, proc->proc_pty); | schedRead(TASK_ROOT(task), fdRx, proc, proc->proc_pty, NULL, 0); |
|
|
/* if Timeout defined, go arm timer */ |
/* if Timeout defined, go arm timer */ |
if (Timeout) { |
if (Timeout) { |
tv.tv_sec = Timeout; |
tv.tv_sec = Timeout; |
schedTimer(TASK_ROOT(task), TOfunc, proc, tv); | schedTimer(TASK_ROOT(task), TOfunc, proc, tv, NULL, 0); |
} |
} |
break; |
break; |
} |
} |