static int inet_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
{
struct sock *sk=(struct sock *)sock->data;
int err, pid;
switch(cmd)
{
case FIOSETOWN:
case SIOCSPGRP:
err=verify_area(VERIFY_READ,(int *)arg,sizeof(long));
if(err)
return err;
pid = get_fs_long((int *) arg);
/* see inet_fcntl */
if (current->pid != pid && current->pgrp != -pid && !suser())
return -EPERM;
sk->proc = pid;
return(0);
case FIOGETOWN:
case SIOCGPGRP:
err=verify_area(VERIFY_WRITE,(void *) arg, sizeof(long));
if(err)
return err;
put_fs_long(sk->proc,(int *)arg);
return(0);
case SIOCGSTAMP:
if(sk->stamp.tv_sec==0)
return -ENOENT;
err=verify_area(VERIFY_WRITE,(void *)arg,sizeof(struct timeval));
if(err)
return err;
memcpy_tofs((void *)arg,&sk->stamp,sizeof(struct timeval));
return 0;
case SIOCADDRT: case SIOCADDRTOLD:
case SIOCDELRT: case SIOCDELRTOLD:
return(ip_rt_ioctl(cmd,(void *) arg));
case SIOCDARP:
case SIOCGARP:
case SIOCSARP:
return(arp_ioctl(cmd,(void *) arg));
#ifdef CONFIG_INET_RARP
case SIOCDRARP:
case SIOCGRARP:
case SIOCSRARP:
return(rarp_ioctl(cmd,(void *) arg));
#endif
case SIOCGIFCONF:
case SIOCGIFFLAGS:
case SIOCSIFFLAGS:
case SIOCGIFADDR:
case SIOCSIFADDR:
/* begin multicast support change */
case SIOCADDMULTI:
case SIOCDELMULTI:
/* end multicast support change */
case SIOCGIFDSTADDR:
case SIOCSIFDSTADDR:
case SIOCGIFBRDADDR:
case SIOCSIFBRDADDR:
case SIOCGIFNETMASK:
case SIOCSIFNETMASK:
case SIOCGIFMETRIC:
case SIOCSIFMETRIC:
case SIOCGIFMEM:
case SIOCSIFMEM:
case SIOCGIFMTU:
case SIOCSIFMTU:
case SIOCSIFLINK:
case SIOCGIFHWADDR:
case SIOCSIFHWADDR:
case OLD_SIOCGIFHWADDR:
case SIOCSIFMAP:
case SIOCGIFMAP:
case SIOCSIFSLAVE:
case SIOCGIFSLAVE:
return(dev_ioctl(cmd,(void *) arg));
default:
if ((cmd >= SIOCDEVPRIVATE) &&
(cmd <= (SIOCDEVPRIVATE + 15)))
return(dev_ioctl(cmd,(void *) arg));
if (sk->prot->ioctl==NULL)
return(-EINVAL);
return(sk->prot->ioctl(sk, cmd, arg));
}
/*NOTREACHED*/
return(0);
}
static inline void process_commands()
{
int ringset_idx;
ipaugenblick_cmd_t *cmd;
struct rte_mbuf *mbuf;
struct socket *sock;
char *p;
struct sockaddr_in addr;
struct sockaddr_in *p_sockaddr;
struct rtentry rtentry;
int len;
cmd = ipaugenblick_dequeue_command_buf();
if(!cmd)
return;
switch(cmd->cmd) {
case IPAUGENBLICK_OPEN_SOCKET_COMMAND:
ipaugenblick_log(IPAUGENBLICK_LOG_DEBUG,"open_sock %x %x %x %x\n",cmd->u.open_sock.family,cmd->u.open_sock.type);
sock = app_glue_create_socket(cmd->u.open_sock.family,cmd->u.open_sock.type);
if(sock) {
ipaugenblick_log(IPAUGENBLICK_LOG_DEBUG,"setting user data %p\n",sock);
socket_satelite_data[cmd->ringset_idx].ringset_idx = cmd->ringset_idx;
socket_satelite_data[cmd->ringset_idx].parent_idx = cmd->parent_idx;
socket_satelite_data[cmd->ringset_idx].apppid = cmd->u.open_sock.pid;
app_glue_set_user_data(sock,(void *)&socket_satelite_data[cmd->ringset_idx]);
socket_satelite_data[cmd->ringset_idx].socket = sock;
ipaugenblick_log(IPAUGENBLICK_LOG_DEBUG,"%d setting tx_space %d\n",__LINE__,sk_stream_wspace(sock->sk));
user_set_socket_tx_space(&g_ipaugenblick_sockets[socket_satelite_data[cmd->ringset_idx].ringset_idx].tx_space,sk_stream_wspace(sock->sk));
}
ipaugenblick_log(IPAUGENBLICK_LOG_DEBUG,"Done\n");
break;
case IPAUGENBLICK_SOCKET_CONNECT_BIND_COMMAND:
if(socket_satelite_data[cmd->ringset_idx].socket) {
if(cmd->u.socket_connect_bind.is_connect) {
ipaugenblick_log(IPAUGENBLICK_LOG_DEBUG,"connect %x\n",cmd->ringset_idx);
if(app_glue_v4_connect(socket_satelite_data[cmd->ringset_idx].socket,
cmd->u.socket_connect_bind.ipaddr,
cmd->u.socket_connect_bind.port)) {
ipaugenblick_log(IPAUGENBLICK_LOG_ERR,"failed to connect socket\n");
}
else {
ipaugenblick_log(IPAUGENBLICK_LOG_DEBUG,"socket connected\n");
len = sizeof(addr);
inet_getname(socket_satelite_data[cmd->ringset_idx].socket,&addr,&len,0);
g_ipaugenblick_sockets[cmd->ringset_idx].local_ipaddr = addr.sin_addr.s_addr;
g_ipaugenblick_sockets[cmd->ringset_idx].local_port = addr.sin_port;
}
}
else {
ipaugenblick_log(IPAUGENBLICK_LOG_DEBUG,"bind %x\n",cmd->ringset_idx);
if(app_glue_v4_bind(socket_satelite_data[cmd->ringset_idx].socket,
cmd->u.socket_connect_bind.ipaddr,
cmd->u.socket_connect_bind.port)) {
ipaugenblick_log(IPAUGENBLICK_LOG_ERR,"cannot bind %x %x\n",cmd->u.socket_connect_bind.ipaddr,cmd->u.socket_connect_bind.port);
}
}
}
else {
ipaugenblick_log(IPAUGENBLICK_LOG_ERR,"no socket to invoke command!!!\n");
}
break;
case IPAUGENBLICK_LISTEN_SOCKET_COMMAND:
ipaugenblick_log(IPAUGENBLICK_LOG_DEBUG,"listen %x\n",cmd->ringset_idx);
if(app_glue_v4_listen(socket_satelite_data[cmd->ringset_idx].socket)) {
ipaugenblick_log(IPAUGENBLICK_LOG_ERR,"failed listening\n");
}
break;
case IPAUGENBLICK_SOCKET_CLOSE_COMMAND:
if(socket_satelite_data[cmd->ringset_idx].socket) {
// ipaugenblick_log(IPAUGENBLICK_LOG_INFO,"closing socket %d %p\n",cmd->ringset_idx,socket_satelite_data[cmd->ringset_idx].socket);
// printf("%s %d %p\n",__FILE__,__LINE__,socket_satelite_data[cmd->ringset_idx].socket);
// user_on_transmission_opportunity(socket_satelite_data[cmd->ringset_idx].socket);
user_flush_rx_tx((struct socket *)socket_satelite_data[cmd->ringset_idx].socket);
app_glue_close_socket((struct socket *)socket_satelite_data[cmd->ringset_idx].socket);
socket_satelite_data[cmd->ringset_idx].socket = NULL;
socket_satelite_data[cmd->ringset_idx].ringset_idx = -1;
socket_satelite_data[cmd->ringset_idx].parent_idx = -1;
ipaugenblick_free_socket(cmd->ringset_idx);
user_sockets_closed++;
}
break;
case IPAUGENBLICK_SOCKET_TX_KICK_COMMAND:
if(socket_satelite_data[cmd->ringset_idx].socket) {
user_kick_tx++;
// user_data_available_cbk(socket_satelite_data[cmd->ringset_idx].socket);
user_on_transmission_opportunity(socket_satelite_data[cmd->ringset_idx].socket);
}
break;
case IPAUGENBLICK_SOCKET_RX_KICK_COMMAND:
if(socket_satelite_data[cmd->ringset_idx].socket) {
user_kick_rx++;
user_data_available_cbk(socket_satelite_data[cmd->ringset_idx].socket);
// user_on_transmission_opportunity(socket_satelite_data[cmd->ringset_idx].socket);
}
break;
case IPAUGENBLICK_SET_SOCKET_RING_COMMAND:
//ipaugenblick_log(IPAUGENBLICK_LOG_DEBUG,"%s %d %d %d %p\n",__FILE__,__LINE__,cmd->ringset_idx,cmd->parent_idx,cmd->u.set_socket_ring.socket_descr);
socket_satelite_data[cmd->ringset_idx].ringset_idx = cmd->ringset_idx;
if(cmd->parent_idx != -1)
socket_satelite_data[cmd->ringset_idx].parent_idx = cmd->parent_idx;
socket_satelite_data[cmd->ringset_idx].apppid = cmd->u.set_socket_ring.pid;
app_glue_set_user_data(cmd->u.set_socket_ring.socket_descr,&socket_satelite_data[cmd->ringset_idx]);
socket_satelite_data[cmd->ringset_idx].socket = cmd->u.set_socket_ring.socket_descr;
//ipaugenblick_log(IPAUGENBLICK_LOG_DEBUG,"setting tx space: %d connidx %d\n",sk_stream_wspace(socket_satelite_data[cmd->ringset_idx].socket->sk),g_ipaugenblick_sockets[socket_satelite_data[cmd->ringset_idx].ringset_idx].connection_idx);
user_set_socket_tx_space(&g_ipaugenblick_sockets[socket_satelite_data[cmd->ringset_idx].ringset_idx].tx_space,sk_stream_wspace(socket_satelite_data[cmd->ringset_idx].socket->sk));
// user_on_transmission_opportunity(socket_satelite_data[cmd->ringset_idx].socket);
user_data_available_cbk(socket_satelite_data[cmd->ringset_idx].socket);
ipaugenblick_mark_writable(&socket_satelite_data[cmd->ringset_idx]);
ipaugenblick_mark_readable(&socket_satelite_data[cmd->ringset_idx]);
user_client_app_accepted++;
break;
case IPAUGENBLICK_SET_SOCKET_SELECT_COMMAND:
// ipaugenblick_log(IPAUGENBLICK_LOG_DEBUG,"setting selector %d for socket %d\n",cmd->u.set_socket_select.socket_select,cmd->ringset_idx);
socket_satelite_data[cmd->ringset_idx].parent_idx = cmd->u.set_socket_select.socket_select;
socket_satelite_data[cmd->ringset_idx].apppid = cmd->u.set_socket_select.pid;
user_data_available_cbk(socket_satelite_data[cmd->ringset_idx].socket);
ipaugenblick_mark_writable(&socket_satelite_data[cmd->ringset_idx]);
ipaugenblick_mark_readable(&socket_satelite_data[cmd->ringset_idx]);
break;
case IPAUGENBLICK_SOCKET_TX_POOL_EMPTY_COMMAND:
if(socket_satelite_data[cmd->ringset_idx].socket) {
if(!socket_satelite_data[cmd->ringset_idx].socket->buffers_available_notification_queue_present) {
TAILQ_INSERT_TAIL(&buffers_available_notification_socket_list_head,socket_satelite_data[cmd->ringset_idx].socket,buffers_available_notification_queue_entry);
socket_satelite_data[cmd->ringset_idx].socket->buffers_available_notification_queue_present = 1;
if(socket_satelite_data[cmd->ringset_idx].socket->type == SOCK_DGRAM)
user_set_socket_tx_space(&g_ipaugenblick_sockets[socket_satelite_data[cmd->ringset_idx].ringset_idx].tx_space,sk_stream_wspace(socket_satelite_data[cmd->ringset_idx].socket->sk));
}
}
break;
case IPAUGENBLICK_ROUTE_ADD_COMMAND:
memset((void *)&rtentry,0,sizeof(rtentry));
rtentry.rt_metric = cmd->u.route.metric;
rtentry.rt_flags = RTF_UP|RTF_GATEWAY;
p_sockaddr = (struct sockaddr_in *)&rtentry.rt_dst;
p_sockaddr->sin_family = AF_INET;
p_sockaddr->sin_addr.s_addr = cmd->u.route.dest_ipaddr;
p_sockaddr = (struct sockaddr_in *)&rtentry.rt_gateway;
p_sockaddr->sin_family = AF_INET;
p_sockaddr->sin_addr.s_addr = cmd->u.route.next_hop;
p_sockaddr = (struct sockaddr_in *)&rtentry.rt_genmask;
p_sockaddr->sin_family = AF_INET;
p_sockaddr->sin_addr.s_addr = cmd->u.route.dest_mask;
if(ip_rt_ioctl(&init_net,SIOCADDRT,&rtentry)) {
ipaugenblick_log(IPAUGENBLICK_LOG_ERR,"CANNOT ADD ROUTE ENTRY %x %x %x\n",
((struct sockaddr_in *)&rtentry.rt_dst)->sin_addr.s_addr,
((struct sockaddr_in *)&rtentry.rt_gateway)->sin_addr.s_addr,
((struct sockaddr_in *)&rtentry.rt_genmask)->sin_addr.s_addr);
}
else {
ipaugenblick_log(IPAUGENBLICK_LOG_INFO,"ROUTE ENTRY %x %x %x is added\n",
((struct sockaddr_in *)&rtentry.rt_dst)->sin_addr.s_addr,
((struct sockaddr_in *)&rtentry.rt_gateway)->sin_addr.s_addr,
((struct sockaddr_in *)&rtentry.rt_genmask)->sin_addr.s_addr);
}
break;
case IPAUGENBLICK_ROUTE_DEL_COMMAND:
memset((void *)&rtentry,0,sizeof(rtentry));
p_sockaddr = (struct sockaddr_in *)&rtentry.rt_dst;
p_sockaddr->sin_family = AF_INET;
p_sockaddr->sin_addr.s_addr = cmd->u.route.dest_ipaddr;
p_sockaddr = (struct sockaddr_in *)&rtentry.rt_gateway;
p_sockaddr->sin_family = AF_INET;
p_sockaddr->sin_addr.s_addr = cmd->u.route.next_hop;
p_sockaddr = (struct sockaddr_in *)&rtentry.rt_genmask;
p_sockaddr->sin_family = AF_INET;
p_sockaddr->sin_addr.s_addr = cmd->u.route.dest_mask;
if(ip_rt_ioctl(&init_net,SIOCDELRT,&rtentry)) {
ipaugenblick_log(IPAUGENBLICK_LOG_ERR,"CANNOT DELETE ROUTE ENTRY %x %x %x\n",
((struct sockaddr_in *)&rtentry.rt_dst)->sin_addr.s_addr,
((struct sockaddr_in *)&rtentry.rt_gateway)->sin_addr.s_addr,
((struct sockaddr_in *)&rtentry.rt_genmask)->sin_addr.s_addr);
}
else {
ipaugenblick_log(IPAUGENBLICK_LOG_INFO,"ROUTE ENTRY %x %x %x is deleted\n",
((struct sockaddr_in *)&rtentry.rt_dst)->sin_addr.s_addr,
((struct sockaddr_in *)&rtentry.rt_gateway)->sin_addr.s_addr,
((struct sockaddr_in *)&rtentry.rt_genmask)->sin_addr.s_addr);
}
break;
case IPAUGENBLICK_CONNECT_CLIENT:
if(cmd->ringset_idx >= IPAUGENBLICK_CLIENTS_POOL_SIZE) {
break;
}
if(!ipaugenblick_clients[cmd->ringset_idx].is_busy) {
TAILQ_INSERT_TAIL(&ipaugenblick_clients_list_head,&ipaugenblick_clients[cmd->ringset_idx],queue_entry);
ipaugenblick_clients[cmd->ringset_idx].is_busy = 1;
on_client_connect(cmd->ringset_idx);
}
break;
case IPAUGENBLICK_DISCONNECT_CLIENT:
if(cmd->ringset_idx >= IPAUGENBLICK_CLIENTS_POOL_SIZE) {
break;
}
if(ipaugenblick_clients[cmd->ringset_idx].is_busy) {
TAILQ_REMOVE(&ipaugenblick_clients_list_head,&ipaugenblick_clients[cmd->ringset_idx],queue_entry);
ipaugenblick_clients[cmd->ringset_idx].is_busy = 0;
}
break;
case IPAUGENBLICK_SETSOCKOPT_COMMAND:
if(socket_satelite_data[cmd->ringset_idx].socket) {
sock_setsockopt(socket_satelite_data[cmd->ringset_idx].socket, cmd->u.setsockopt.level, cmd->u.setsockopt.optname, cmd->u.setsockopt.optval, cmd->u.setsockopt.optlen);
}
break;
case IPAUGENBLICK_SOCKET_SHUTDOWN_COMMAND:
if(socket_satelite_data[cmd->ringset_idx].socket) {
inet_shutdown(socket_satelite_data[cmd->ringset_idx].socket, cmd->u.socket_shutdown.how);
user_sockets_shutdown++;
}
break;
case IPAUGENBLICK_SOCKET_DECLINE_COMMAND:
user_flush_rx_tx((struct socket *)cmd->u.socket_decline.socket_descr);
app_glue_close_socket((struct socket *)cmd->u.socket_decline.socket_descr);
user_sockets_closed++;
break;
default:
ipaugenblick_log(IPAUGENBLICK_LOG_ERR,"unknown cmd %d\n",cmd->cmd);
break;
}
ipaugenblick_free_command_buf(cmd);
}
