|
@@ -34,6 +34,7 @@
|
|
|
#include "NetconEthernetTap.hpp"
|
|
|
|
|
|
#include "../node/Utils.hpp"
|
|
|
+#include "../node/Node.hpp" // for TRACE
|
|
|
#include "../osdep/OSUtils.hpp"
|
|
|
#include "../osdep/Phy.hpp"
|
|
|
|
|
@@ -217,6 +218,7 @@ void NetconEthernetTap::closeConnection(NetconConnection *conn)
|
|
|
void NetconEthernetTap::threadMain()
|
|
|
throw()
|
|
|
{
|
|
|
+ TRACE("starting threadMain()");
|
|
|
static ip_addr_t ipaddr, netmask, gw;
|
|
|
char ip_str[16] = {0}, nm_str[16] = {0}, gw_str[16] = {0};
|
|
|
IP4_ADDR(&gw, 192,168,0,1);
|
|
@@ -300,7 +302,7 @@ void NetconEthernetTap::phyOnUnixAccept(PhySocket *sockL,PhySocket *sockN,void *
|
|
|
|
|
|
void NetconEthernetTap::phyOnUnixClose(PhySocket *sock,void **uptr)
|
|
|
{
|
|
|
- ((NetconClient*)*uptr)->closeClient();
|
|
|
+ closeClient(((NetconClient*)*uptr));
|
|
|
}
|
|
|
|
|
|
void NetconEthernetTap::phyOnUnixData(PhySocket *sock,void **uptr,void *data,unsigned long len)
|
|
@@ -310,33 +312,39 @@ void NetconEthernetTap::phyOnUnixData(PhySocket *sock,void **uptr,void *data,uns
|
|
|
switch(buf[0])
|
|
|
{
|
|
|
case RPC_SOCKET:
|
|
|
+ TRACE("RPC_SOCKET");
|
|
|
struct socket_st socket_rpc;
|
|
|
memcpy(&socket_rpc, &buf[1], sizeof(struct socket_st));
|
|
|
client->tid = socket_rpc.__tid;
|
|
|
handle_socket(client, &socket_rpc);
|
|
|
break;
|
|
|
case RPC_LISTEN:
|
|
|
+ TRACE("RPC_LISTEN");
|
|
|
struct listen_st listen_rpc;
|
|
|
memcpy(&listen_rpc, &buf[1], sizeof(struct listen_st));
|
|
|
client->tid = listen_rpc.__tid;
|
|
|
handle_listen(client, &listen_rpc);
|
|
|
break;
|
|
|
case RPC_BIND:
|
|
|
+ TRACE("RPC_BIND");
|
|
|
struct bind_st bind_rpc;
|
|
|
memcpy(&bind_rpc, &buf[1], sizeof(struct bind_st));
|
|
|
client->tid = bind_rpc.__tid;
|
|
|
handle_bind(client, &bind_rpc);
|
|
|
break;
|
|
|
case RPC_KILL_INTERCEPT:
|
|
|
- client->closeClient();
|
|
|
+ TRACE("RPC_KILL_INTERCEPT");
|
|
|
+ closeClient(client);
|
|
|
break;
|
|
|
case RPC_CONNECT:
|
|
|
+ TRACE("RPC_CONNECT");
|
|
|
struct connect_st connect_rpc;
|
|
|
memcpy(&connect_rpc, &buf[1], sizeof(struct connect_st));
|
|
|
client->tid = connect_rpc.__tid;
|
|
|
handle_connect(client, &connect_rpc);
|
|
|
break;
|
|
|
case RPC_FD_MAP_COMPLETION:
|
|
|
+ TRACE("RPC_FD_MAP_COMPLETION");
|
|
|
handle_retval(client, buf);
|
|
|
break;
|
|
|
default:
|
|
@@ -351,7 +359,7 @@ void NetconEthernetTap::phyOnUnixWritable(PhySocket *sock,void **uptr)
|
|
|
int NetconEthernetTap::send_return_value(NetconClient *client, int retval)
|
|
|
{
|
|
|
if(!client->waiting_for_retval){
|
|
|
- // intercept isn't waiting for return value. Why are we here?
|
|
|
+ TRACE("intercept isn't waiting for return value. Why are we here?");
|
|
|
return 0;
|
|
|
}
|
|
|
char retmsg[4];
|
|
@@ -365,7 +373,7 @@ int NetconEthernetTap::send_return_value(NetconClient *client, int retval)
|
|
|
client->waiting_for_retval = false;
|
|
|
}
|
|
|
else {
|
|
|
- // unable to send return value to the intercept
|
|
|
+ TRACE("unable to send return value to the intercept");
|
|
|
closeClient(client);
|
|
|
}
|
|
|
return n;
|
|
@@ -377,6 +385,7 @@ int NetconEthernetTap::send_return_value(NetconClient *client, int retval)
|
|
|
|
|
|
err_t NetconEthernetTap::nc_poll(void* arg, struct tcp_pcb *tpcb)
|
|
|
{
|
|
|
+ TRACE("nc_poll");
|
|
|
Larg *l = (Larg*)arg;
|
|
|
NetconConnection *c = l->tap->getConnectionByPCB(tpcb);
|
|
|
NetconEthernetTap *tap = l->tap;
|
|
@@ -387,11 +396,13 @@ err_t NetconEthernetTap::nc_poll(void* arg, struct tcp_pcb *tpcb)
|
|
|
|
|
|
err_t NetconEthernetTap::nc_accept(void *arg, struct tcp_pcb *newpcb, err_t err)
|
|
|
{
|
|
|
+ TRACE("nc_accept");
|
|
|
return ERR_OK;
|
|
|
}
|
|
|
|
|
|
err_t NetconEthernetTap::nc_recved(void *arg, struct tcp_pcb *tpcb, struct pbuf *p, err_t err)
|
|
|
{
|
|
|
+ TRACE("nc_recved");
|
|
|
Larg *l = (Larg*)arg;
|
|
|
NetconConnection *c = l->tap->getConnectionByPCB(tpcb);
|
|
|
NetconEthernetTap *tap = l->tap;
|
|
@@ -410,7 +421,7 @@ err_t NetconEthernetTap::nc_recved(void *arg, struct tcp_pcb *tpcb, struct pbuf
|
|
|
tap->closeConnection(c);
|
|
|
}
|
|
|
else {
|
|
|
- // can't locate connection via (arg)
|
|
|
+ TRACE("can't locate connection via (arg)");
|
|
|
}
|
|
|
return err;
|
|
|
}
|
|
@@ -420,13 +431,13 @@ err_t NetconEthernetTap::nc_recved(void *arg, struct tcp_pcb *tpcb, struct pbuf
|
|
|
break; // ?
|
|
|
if((n = write(our_fd, p->payload, p->len)) > 0) {
|
|
|
if(n < p->len) {
|
|
|
- // ERROR: unable to write entire pbuf to buffer
|
|
|
+ TRACE("ERROR: unable to write entire pbuf to buffer");
|
|
|
//tap->_phy.setNotifyWritable(l->sock, true);
|
|
|
}
|
|
|
tap->lwipstack->tcp_recved(tpcb, n);
|
|
|
}
|
|
|
else {
|
|
|
- // Error: No data written to intercept buffer
|
|
|
+ TRACE("Error: No data written to intercept buffer");
|
|
|
}
|
|
|
p = p->next;
|
|
|
}
|
|
@@ -436,6 +447,7 @@ err_t NetconEthernetTap::nc_recved(void *arg, struct tcp_pcb *tpcb, struct pbuf
|
|
|
|
|
|
void NetconEthernetTap::nc_err(void *arg, err_t err)
|
|
|
{
|
|
|
+ TRACE("nc_err");
|
|
|
Larg *l = (Larg*)arg;
|
|
|
NetconEthernetTap *tap = l->tap;
|
|
|
NetconConnection *c = tap->getConnectionByThisFD(tap->_phy.getDescriptor(l->sock));
|
|
@@ -443,12 +455,14 @@ void NetconEthernetTap::nc_err(void *arg, err_t err)
|
|
|
tap->closeConnection(c);
|
|
|
}
|
|
|
else {
|
|
|
- // can't locate connection object for PCB
|
|
|
+ TRACE("can't locate connection object for PCB");
|
|
|
}
|
|
|
}
|
|
|
|
|
|
void NetconEthernetTap::nc_close(struct tcp_pcb* tpcb)
|
|
|
{
|
|
|
+ TRACE("nc_close");
|
|
|
+ //closeConnection(getConnectionByPCB(tpcb));
|
|
|
/*
|
|
|
lwipstack->tcp_arg(tpcb, NULL);
|
|
|
lwipstack->tcp_sent(tpcb, NULL);
|
|
@@ -456,24 +470,26 @@ void NetconEthernetTap::nc_close(struct tcp_pcb* tpcb)
|
|
|
lwipstack->tcp_err(tpcb, NULL);
|
|
|
lwipstack->tcp_poll(tpcb, NULL, 0);
|
|
|
lwipstack->tcp_close(tpcb);
|
|
|
- */
|
|
|
+ */
|
|
|
}
|
|
|
|
|
|
err_t NetconEthernetTap::nc_send(struct tcp_pcb *tpcb)
|
|
|
{
|
|
|
+ TRACE("nc_send");
|
|
|
return ERR_OK;
|
|
|
}
|
|
|
|
|
|
err_t NetconEthernetTap::nc_sent(void* arg, struct tcp_pcb *tpcb, u16_t len)
|
|
|
{
|
|
|
+ TRACE("nc_sent");
|
|
|
return len;
|
|
|
}
|
|
|
|
|
|
err_t NetconEthernetTap::nc_connected(void *arg, struct tcp_pcb *tpcb, err_t err)
|
|
|
{
|
|
|
+ TRACE("nc_connected");
|
|
|
Larg *l = (Larg*)arg;
|
|
|
NetconEthernetTap *tap = l->tap;
|
|
|
-
|
|
|
for(size_t i=0; i<tap->clients.size(); i++) {
|
|
|
if(tap->clients[i]->containsPCB(tpcb)) {
|
|
|
tap->send_return_value(tap->clients[i],err);
|
|
@@ -511,18 +527,18 @@ void NetconEthernetTap::handle_bind(NetconClient *client, struct bind_st *bind_r
|
|
|
if(c->pcb->state == CLOSED){
|
|
|
int err = lwipstack->tcp_bind(c->pcb, &conn_addr, conn_port);
|
|
|
if(err != ERR_OK) {
|
|
|
- // error while binding to addr/port
|
|
|
+ TRACE("error while binding to addr/port");
|
|
|
}
|
|
|
else {
|
|
|
- // bind successful
|
|
|
+ TRACE("bind successful");
|
|
|
}
|
|
|
}
|
|
|
else {
|
|
|
- // PCB not in CLOSED state. Ignoring BIND request.
|
|
|
+ TRACE("PCB not in CLOSED state. Ignoring BIND request.");
|
|
|
}
|
|
|
}
|
|
|
else {
|
|
|
- // can't locate connection for PCB
|
|
|
+ TRACE("can't locate connection for PCB");
|
|
|
}
|
|
|
}
|
|
|
|
|
@@ -531,7 +547,7 @@ void NetconEthernetTap::handle_listen(NetconClient *client, struct listen_st *li
|
|
|
NetconConnection *c = client->getConnectionByTheirFD(listen_rpc->sockfd);
|
|
|
if(c) {
|
|
|
if(c->pcb->state == LISTEN) {
|
|
|
- // PCB is already in listening state.
|
|
|
+ TRACE("PCB is already in listening state.");
|
|
|
return;
|
|
|
}
|
|
|
struct tcp_pcb* listening_pcb = lwipstack->tcp_listen(c->pcb);
|
|
@@ -542,11 +558,11 @@ void NetconEthernetTap::handle_listen(NetconClient *client, struct listen_st *li
|
|
|
client->waiting_for_retval=true;
|
|
|
}
|
|
|
else {
|
|
|
- // unable to allocate memory for new listening PCB
|
|
|
+ TRACE("unable to allocate memory for new listening PCB");
|
|
|
}
|
|
|
}
|
|
|
else {
|
|
|
- // can't locate connection for PCB
|
|
|
+ TRACE("can't locate connection for PCB");
|
|
|
}
|
|
|
}
|
|
|
|
|
@@ -570,7 +586,7 @@ void NetconEthernetTap::handle_socket(NetconClient *client, struct socket_st* so
|
|
|
client->unmapped_conn = new_conn;
|
|
|
}
|
|
|
else {
|
|
|
- // Memory not available for new PCB
|
|
|
+ TRACE("Memory not available for new PCB");
|
|
|
}
|
|
|
}
|
|
|
|
|
@@ -608,7 +624,7 @@ void NetconEthernetTap::handle_connect(NetconClient *client, struct connect_st*
|
|
|
client->waiting_for_retval=true;
|
|
|
}
|
|
|
else {
|
|
|
- // could not locate PCB based on their fd
|
|
|
+ TRACE("could not locate PCB based on their fd");
|
|
|
}
|
|
|
}
|
|
|
|
|
@@ -629,7 +645,7 @@ void NetconEthernetTap::handle_write(NetconConnection *c)
|
|
|
if(write_allowance > 0) {
|
|
|
int err = lwipstack->tcp_write(c->pcb, &c->buf, write_allowance, TCP_WRITE_FLAG_COPY);
|
|
|
if(err != ERR_OK) {
|
|
|
- // error while writing to PCB
|
|
|
+ TRACE("error while writing to PCB");
|
|
|
return;
|
|
|
}
|
|
|
else {
|
|
@@ -643,12 +659,12 @@ void NetconEthernetTap::handle_write(NetconConnection *c)
|
|
|
}
|
|
|
}
|
|
|
else {
|
|
|
- // lwIP stack full
|
|
|
+ TRACE("lwIP stack full");
|
|
|
return;
|
|
|
}
|
|
|
}
|
|
|
else {
|
|
|
- // could not locate connection for this fd
|
|
|
+ TRACE("could not locate connection for this fd");
|
|
|
}
|
|
|
}
|
|
|
|