2014-07-11 22:12:11 +02:00
|
|
|
#include <stdlib.h>
|
|
|
|
#include <stdint.h>
|
|
|
|
#include <string.h>
|
|
|
|
#include <stdio.h>
|
|
|
|
|
|
|
|
#include <arpa/inet.h>
|
|
|
|
|
|
|
|
#include "wtplist.h"
|
|
|
|
|
|
|
|
#include "capwap.h"
|
2014-07-19 12:36:43 +02:00
|
|
|
#include "sock.h"
|
2014-07-11 22:12:11 +02:00
|
|
|
#include "socklist.h"
|
|
|
|
|
|
|
|
#include "conn.h"
|
|
|
|
#include "wtpman.h"
|
|
|
|
#include "conf.h"
|
|
|
|
#include "cw_log.h"
|
|
|
|
|
|
|
|
#include "dtls.h"
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#include "conf.h"
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#include <errno.h>
|
|
|
|
|
|
|
|
#include "capwap.h"
|
|
|
|
|
|
|
|
|
2014-07-19 12:36:43 +02:00
|
|
|
/* macro to convert our client ip to a string */
|
2014-07-19 17:17:27 +02:00
|
|
|
#define CLIENT_IP (sock_addrtostr((struct sockaddr*)&wtpman->conn->addr, (char[64]){0},64))
|
2014-07-19 12:36:43 +02:00
|
|
|
|
|
|
|
|
2014-07-11 22:12:11 +02:00
|
|
|
|
|
|
|
ACIPLIST * get_aciplist();
|
|
|
|
struct ac_info * get_acinfo();
|
|
|
|
|
|
|
|
static void wtpman_remove(struct wtpman * wtpman)
|
|
|
|
{
|
|
|
|
wtplist_lock();
|
|
|
|
wtplist_remove(wtpman);
|
|
|
|
wtplist_unlock();
|
|
|
|
wtpman_destroy(wtpman);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void wtpman_run_discovery(void *arg)
|
|
|
|
{
|
|
|
|
struct wtpman * wtpman = (struct wtpman *)arg;
|
|
|
|
|
|
|
|
struct cwrmsg * cwrmsg;
|
|
|
|
// do {
|
|
|
|
cwrmsg = conn_get_message(wtpman->conn);
|
|
|
|
// }while (!cwrmsg);
|
|
|
|
|
|
|
|
|
|
|
|
if ( !cwrmsg)
|
|
|
|
{
|
|
|
|
wtpman_remove(wtpman);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (cwrmsg->type==CWMSG_DISCOVERY_REQUEST){
|
|
|
|
process_discovery_request(&wtpman->wtpinfo,cwrmsg->msgelems,cwrmsg->msgelems_len);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
struct radioinfo radioinfo;
|
|
|
|
radioinfo.rid = cwrmsg->rid;
|
|
|
|
radioinfo.rmac = cwrmsg->rmac;
|
|
|
|
struct ac_info * acinfo = get_acinfo();
|
|
|
|
|
|
|
|
// wtpinfo_print(&wtpman->wtpinfo);
|
|
|
|
|
|
|
|
cwsend_discovery_response(wtpman->conn,cwrmsg->seqnum,&radioinfo,acinfo,&wtpman->wtpinfo);
|
|
|
|
}
|
|
|
|
|
|
|
|
wtpman_remove(wtpman);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2014-07-19 12:36:43 +02:00
|
|
|
|
2014-07-11 22:12:11 +02:00
|
|
|
static void wtpman_run(void *arg)
|
|
|
|
{
|
|
|
|
struct wtpman * wtpman = (struct wtpman *)arg;
|
|
|
|
struct cwrmsg * cwrmsg = conn_get_message(wtpman->conn);
|
|
|
|
|
|
|
|
|
|
|
|
if (socklist[wtpman->socklistindex].type != SOCKLIST_UNICAST_SOCKET){
|
2014-07-19 12:36:43 +02:00
|
|
|
cw_log_debug0("Dropping connection from %s to non-unicast socket", CLIENT_IP);
|
2014-07-11 22:12:11 +02:00
|
|
|
wtpman_remove(wtpman);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2014-07-19 12:36:43 +02:00
|
|
|
cw_log_debug0("Establishing DTLS connection from %s",CLIENT_IP);
|
2014-07-11 22:12:11 +02:00
|
|
|
|
2014-07-13 13:07:37 +02:00
|
|
|
#ifdef WITH_DTLS
|
2014-07-11 22:12:11 +02:00
|
|
|
if (!conf_dtls_psk){
|
|
|
|
cw_log(LOG_ERR,"Cant' establish DTLS connection, no psk set in config file");
|
|
|
|
wtpman_remove(wtpman);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
wtpman->conn->dtls_psk=conf_dtls_psk;
|
|
|
|
wtpman->conn->dtls_psk_len=strlen(conf_dtls_psk);
|
|
|
|
wtpman->conn->dtls_cipher=CAPWAP_CIPHER;
|
|
|
|
|
|
|
|
if ( !dtls_accept(wtpman->conn) ){
|
2014-07-19 12:36:43 +02:00
|
|
|
cw_log_debug0("Error establishing DTLS connection from %s",CLIENT_IP);
|
2014-07-11 22:12:11 +02:00
|
|
|
wtpman_remove(wtpman);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
#endif
|
2014-07-19 12:36:43 +02:00
|
|
|
// const struct sockaddr *sa, char *s, size_t maxlen
|
|
|
|
|
|
|
|
cw_log_debug0("DTLS Session established with %s", CLIENT_IP);
|
|
|
|
|
|
|
|
|
2014-07-11 22:12:11 +02:00
|
|
|
cwrmsg = conn_get_message(wtpman->conn);
|
|
|
|
// printf("Seqnum: %i\n",cwrmsg->seqnum);
|
|
|
|
|
|
|
|
if (cwrmsg->type != CWMSG_JOIN_REQUEST){
|
|
|
|
cw_log_debug0("Join request expected but got %i",cwrmsg->type);
|
|
|
|
wtpman_remove(wtpman);
|
|
|
|
return;
|
|
|
|
|
|
|
|
}
|
|
|
|
process_join_request(&wtpman->wtpinfo,cwrmsg->msgelems,cwrmsg->msgelems_len);
|
|
|
|
|
|
|
|
struct radioinfo radioinfo;
|
|
|
|
radioinfo.rid = cwrmsg->rid;
|
|
|
|
radioinfo.rmac = cwrmsg->rmac;
|
|
|
|
struct ac_info * acinfo = get_acinfo();
|
|
|
|
|
|
|
|
// printf("ACN: %s\n",acinfo->ac_name);
|
|
|
|
|
|
|
|
int result_code = 1;
|
|
|
|
cwsend_join_response(wtpman->conn,cwrmsg->seqnum,result_code,&radioinfo,acinfo,&wtpman->wtpinfo);
|
|
|
|
|
2014-07-19 17:17:27 +02:00
|
|
|
cw_log_debug0("WTP joined %s,%s",wtpman->wtpinfo.name,wtpman->wtpinfo.location);
|
2014-07-11 22:12:11 +02:00
|
|
|
|
2014-07-19 20:35:08 +02:00
|
|
|
char wtpinfostr[8192];
|
|
|
|
wtpinfo_print(wtpinfostr,&wtpman->wtpinfo);
|
|
|
|
|
|
|
|
cw_log_debug0("WTP joined\n%s",wtpinfostr);
|
|
|
|
|
2014-07-11 22:12:11 +02:00
|
|
|
int msg_counter = 0;
|
|
|
|
while(1){
|
|
|
|
struct cwrmsg * cwrmsg = conn_get_message(wtpman->conn);
|
|
|
|
if (!cwrmsg) {
|
|
|
|
msg_counter++;
|
|
|
|
if (msg_counter < CAPWAP_ECHO_INTERVAL *2 )
|
|
|
|
continue;
|
|
|
|
|
|
|
|
cw_log_debug0("WTP died");
|
|
|
|
wtpman_remove(wtpman);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
msg_counter=0;
|
|
|
|
|
|
|
|
|
|
|
|
if (cwrmsg->type = CWMSG_ECHO_REQUEST){
|
|
|
|
cwsend_echo_response(wtpman->conn,cwrmsg->seqnum,wtpman->wtpinfo.radioinfo);
|
|
|
|
}
|
|
|
|
printf("Got msg: %i\n",cwrmsg->type);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// process_discovery(wtpman,cwrmsg);
|
|
|
|
exit(0);
|
|
|
|
|
|
|
|
|
|
|
|
printf("Messag gote ssl\n");
|
|
|
|
|
|
|
|
printf("Precdeis sssl\n");
|
|
|
|
|
|
|
|
printf ("SEQNUM REC: %i\n",cwrmsg->seqnum);
|
|
|
|
|
|
|
|
printf("procdis ende\n");
|
|
|
|
|
|
|
|
|
|
|
|
exit(0);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
while (1)
|
|
|
|
{
|
|
|
|
/*
|
|
|
|
sem_wait(&wtpman->q_sem);
|
|
|
|
int qrpos = wtpman->qrpos+1;
|
|
|
|
if (qrpos==WTPMAN_QSIZE)
|
|
|
|
qrpos=0;
|
|
|
|
wtpman->qrpos=qrpos;
|
|
|
|
|
|
|
|
uint8_t * packet = wtpman->q[qrpos]+4;
|
|
|
|
int len = *( (uint32_t*)(wtpman->q[qrpos]));
|
|
|
|
*/
|
|
|
|
uint8_t * packet = conn_q_get_packet(wtpman->conn);
|
|
|
|
int len = *( (uint32_t*)(packet));
|
|
|
|
|
|
|
|
|
|
|
|
// conn_process_packet(wtpman->conn,packet+4,len);
|
|
|
|
free(packet);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void wtpman_destroy(struct wtpman * wtpman)
|
|
|
|
{
|
|
|
|
if ( wtpman->conn)
|
|
|
|
conn_destroy(wtpman->conn);
|
|
|
|
free (wtpman);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
struct wtpman * wtpman_create(int socklistindex,struct sockaddr * srcaddr)
|
|
|
|
{
|
|
|
|
struct wtpman * wtpman;
|
|
|
|
wtpman = malloc(sizeof(struct wtpman));
|
|
|
|
if (!wtpman)
|
|
|
|
return 0;
|
|
|
|
memset (wtpman,0,sizeof(struct wtpman));
|
|
|
|
|
|
|
|
int sockfd = socklist[socklistindex].reply_sockfd;
|
|
|
|
|
|
|
|
// wtpman->conn=conn_create(sockfd,srcaddr,process_discovery,wtpman,100);
|
|
|
|
wtpman->conn=conn_create(sockfd,srcaddr,100);
|
|
|
|
if (!wtpman->conn){
|
|
|
|
wtpman_destroy(wtpman);
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
return wtpman;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void wtpman_addpacket(struct wtpman * wtpman,uint8_t *packet,int len)
|
|
|
|
{
|
|
|
|
conn_q_add_packet(wtpman->conn,packet,len);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void wtpman_start(struct wtpman * wtpman,int dtlsmode)
|
|
|
|
{
|
|
|
|
if ( dtlsmode )
|
|
|
|
pthread_create (&wtpman->thread, NULL, (void *) &wtpman_run, (void *) wtpman);
|
|
|
|
else
|
|
|
|
pthread_create (&wtpman->thread, NULL, (void *) &wtpman_run_discovery, (void *) wtpman);
|
|
|
|
}
|