Compare commits
64 Commits
v0.0.0
...
b54f4fb9fa
Author | SHA1 | Date | |
---|---|---|---|
b54f4fb9fa | |||
7420a5d2fc | |||
c2cb96e5dc | |||
9307b05b46 | |||
be210692c6 | |||
a051ba41de | |||
df5e2bcbb7 | |||
daa808f9a2 | |||
5f16ed5455 | |||
85f79eac6a | |||
e2e6d29069 | |||
fc9ee8dfc2 | |||
143ffb1e08 | |||
f17496592f | |||
e53b7f1142 | |||
459e2e2aeb | |||
b158544f1a | |||
46a932dc4b | |||
ff8d520972 | |||
a3f7a4fc1a | |||
c2e323c941 | |||
3a8159320f | |||
6a64e28982 | |||
6dbf0bc706 | |||
370942ef7e | |||
add6ffa314 | |||
ce4a1dd2df | |||
e5f5687b2b | |||
bf8a8c6d53 | |||
10b88b8f86 | |||
e6e8c8ed32 | |||
c5e1abb842 | |||
9e54e46e45 | |||
f8654a0408 | |||
1703be9294 | |||
d8f18f1a6a | |||
4b5b00009c | |||
3da4805c06 | |||
5b25d49b2b | |||
484be39f78 | |||
0739d57aa6 | |||
fe16e62ef2 | |||
8a1a713c12 | |||
14e69d168b | |||
bc5e312ec4 | |||
d2240646f9 | |||
8aa11dccba | |||
7d28858a70 | |||
8db182a303 | |||
9452589625 | |||
be3adf279d | |||
1544c6aa1b | |||
a3bc9dd09c | |||
fb280d1c1c | |||
5240553144 | |||
1598abee34 | |||
156466eab9 | |||
04d469b970 | |||
0e07e42167 | |||
4c37d89f03 | |||
6d9da94863 | |||
1616d77a0f | |||
a389003199 | |||
eac5e73528 |
18
Makefile
18
Makefile
@ -1,13 +1,23 @@
|
|||||||
|
.OBJDIR: ./
|
||||||
|
|
||||||
all:
|
all: ac wtp
|
||||||
$(MAKE) -C src/cw
|
|
||||||
$(MAKE) -C src/mod
|
|
||||||
$(MAKE) -C src/ac
|
|
||||||
|
|
||||||
|
|
||||||
clean:
|
clean:
|
||||||
$(MAKE) -C src/cw clean
|
$(MAKE) -C src/cw clean
|
||||||
$(MAKE) -C src/mod clean
|
$(MAKE) -C src/mod clean
|
||||||
$(MAKE) -C src/ac clean
|
$(MAKE) -C src/ac clean
|
||||||
|
$(MAKE) -C src/wtp clean
|
||||||
|
|
||||||
|
cw:
|
||||||
|
$(MAKE) -C src/cw
|
||||||
|
|
||||||
|
ac: cw mod
|
||||||
|
$(MAKE) -C src/ac
|
||||||
|
|
||||||
|
wtp: cw mod
|
||||||
|
$(MAKE) -C src/wtp
|
||||||
|
|
||||||
|
mod: cw
|
||||||
|
$(MAKE) -C src/mod
|
||||||
|
|
||||||
|
@ -9,6 +9,8 @@ OBJS = \
|
|||||||
socklist.o \
|
socklist.o \
|
||||||
discovery_cache.o\
|
discovery_cache.o\
|
||||||
shell.o\
|
shell.o\
|
||||||
|
statemachine.o\
|
||||||
|
|
||||||
|
|
||||||
PRG=actube
|
PRG=actube
|
||||||
LIBPATH=-L../../lib/$(KERNEL)/$(ARCH)/ -L/usr/local/lib -L/usr/lib
|
LIBPATH=-L../../lib/$(KERNEL)/$(ARCH)/ -L/usr/local/lib -L/usr/lib
|
||||||
@ -17,7 +19,6 @@ LIBS+=-lmavl
|
|||||||
LIBS+=-lcw
|
LIBS+=-lcw
|
||||||
LIBS+=-lrt
|
LIBS+=-lrt
|
||||||
LIBS+=-lpthread
|
LIBS+=-lpthread
|
||||||
LIBS+=-lconfuse
|
|
||||||
LIBS+=-lc
|
LIBS+=-lc
|
||||||
LIBS+=-lnettle
|
LIBS+=-lnettle
|
||||||
LIBS+=-lssl
|
LIBS+=-lssl
|
||||||
|
@ -4,8 +4,6 @@
|
|||||||
#include "mavl.h"
|
#include "mavl.h"
|
||||||
#include "cw/mavltypes.h"
|
#include "cw/mavltypes.h"
|
||||||
|
|
||||||
extern mavl_t actube_global_cfg;
|
|
||||||
|
|
||||||
|
|
||||||
extern struct ac_status ac_global_status;
|
extern struct ac_status ac_global_status;
|
||||||
|
|
||||||
@ -21,6 +19,7 @@ enum {
|
|||||||
AC_PROTO_UNKNOWN
|
AC_PROTO_UNKNOWN
|
||||||
};
|
};
|
||||||
|
|
||||||
|
void start_shell();
|
||||||
|
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
212
src/ac/ac_main.c
212
src/ac/ac_main.c
@ -48,8 +48,9 @@
|
|||||||
|
|
||||||
#include "cw/cfg.h"
|
#include "cw/cfg.h"
|
||||||
|
|
||||||
int ac_run();
|
int ac_run(cw_Cfg_t * cfg);
|
||||||
|
|
||||||
|
#include "statemachine.h"
|
||||||
|
|
||||||
#include <getopt.h>
|
#include <getopt.h>
|
||||||
|
|
||||||
@ -64,7 +65,7 @@ static int parse_args (int argc, char *argv[], struct bootcfg * bootcfg)
|
|||||||
int c;
|
int c;
|
||||||
opterr = 1;
|
opterr = 1;
|
||||||
|
|
||||||
bootcfg->cfgfilename = "config.atv";
|
bootcfg->cfgfilename = "config.ckv";
|
||||||
|
|
||||||
while ( (c = getopt (argc, argv, "vc:d:p:")) != -1) {
|
while ( (c = getopt (argc, argv, "vc:d:p:")) != -1) {
|
||||||
|
|
||||||
@ -104,7 +105,6 @@ static int parse_args (int argc, char *argv[], struct bootcfg * bootcfg)
|
|||||||
|
|
||||||
|
|
||||||
struct cw_DiscoveryCache * discovery_cache;
|
struct cw_DiscoveryCache * discovery_cache;
|
||||||
mavl_t actube_global_cfg;
|
|
||||||
|
|
||||||
int ac_global_init()
|
int ac_global_init()
|
||||||
{
|
{
|
||||||
@ -141,52 +141,6 @@ extern void test_sets();
|
|||||||
|
|
||||||
|
|
||||||
#include "discovery_cache.h"
|
#include "discovery_cache.h"
|
||||||
void tester1()
|
|
||||||
{
|
|
||||||
struct cw_DiscoveryCache * cache;
|
|
||||||
struct sockaddr_storage addr;
|
|
||||||
int rc;
|
|
||||||
const char *c,*b;
|
|
||||||
|
|
||||||
cache = discovery_cache_create(1);
|
|
||||||
|
|
||||||
sock_strtoaddr("192.168.0.12:1234",(struct sockaddr*)&addr);
|
|
||||||
discovery_cache_add(cache,(struct sockaddr*)&addr,"Nase","Loeffel");
|
|
||||||
|
|
||||||
sock_strtoaddr("192.168.0.13:1234",(struct sockaddr*)&addr);
|
|
||||||
discovery_cache_add(cache,(struct sockaddr*)&addr,"Nase","Loeffel");
|
|
||||||
|
|
||||||
|
|
||||||
rc = discovery_cache_get(cache,(struct sockaddr*)&addr,&c,&b);
|
|
||||||
|
|
||||||
if (rc) {
|
|
||||||
printf("RC: %d, %s %s\n",rc,c,b);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
static void show_cfg (FILE *out, mavl_t ktv)
|
|
||||||
{
|
|
||||||
char value[500];
|
|
||||||
struct cw_Val * data;
|
|
||||||
mavliter_t it;
|
|
||||||
const struct cw_Type * type;
|
|
||||||
|
|
||||||
|
|
||||||
mavliter_init(&it,ktv);
|
|
||||||
|
|
||||||
mavliter_foreach(&it){
|
|
||||||
|
|
||||||
data = mavliter_get(&it);
|
|
||||||
type = data->type;
|
|
||||||
type->to_str(data,value,0);
|
|
||||||
|
|
||||||
fprintf(out,"%s :%s: %s\n",data->key,type->get_type_name(data), value);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
{
|
{
|
||||||
cw_Cfg_t * cfg;
|
cw_Cfg_t * cfg;
|
||||||
@ -214,22 +168,21 @@ static void show_cfg (FILE *out, mavl_t ktv)
|
|||||||
return 0;
|
return 0;
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
static cw_Cfg_t * global_cfg = NULL;
|
||||||
|
|
||||||
|
|
||||||
int main (int argc, char *argv[])
|
int main (int argc, char *argv[])
|
||||||
{
|
{
|
||||||
int rc = 0;
|
int rc = 0;
|
||||||
struct bootcfg bootcfg;
|
struct bootcfg bootcfg;
|
||||||
FILE * file;
|
|
||||||
mavl_t types_tree, acglobal_cfg;
|
|
||||||
const cw_Type_t **ti;
|
|
||||||
|
|
||||||
|
|
||||||
cw_Cfg_t * global_cfg = NULL;
|
|
||||||
|
|
||||||
/* parse arguments */
|
/* parse arguments */
|
||||||
parse_args (argc, argv, &bootcfg);
|
parse_args (argc, argv, &bootcfg);
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
global_cfg=cw_cfg_create();
|
global_cfg=cw_cfg_create();
|
||||||
if (!global_cfg){
|
if (!global_cfg){
|
||||||
fprintf(stderr,"Can't create global_cfg: %s\n",strerror(errno));
|
fprintf(stderr,"Can't create global_cfg: %s\n",strerror(errno));
|
||||||
@ -239,75 +192,50 @@ int main (int argc, char *argv[])
|
|||||||
rc = cw_cfg_load(bootcfg.cfgfilename,global_cfg);
|
rc = cw_cfg_load(bootcfg.cfgfilename,global_cfg);
|
||||||
if (rc)
|
if (rc)
|
||||||
{
|
{
|
||||||
if (rc<0)
|
if (rc)
|
||||||
fprintf(stderr,"Can't load cfg '%s': %s\n",bootcfg.cfgfilename,strerror(errno));
|
fprintf(stderr,"Can't load cfg '%s': %s\n",bootcfg.cfgfilename,strerror(errno));
|
||||||
goto errX;
|
goto errX;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/* open config file */
|
|
||||||
file = fopen("config.ktv","r");
|
|
||||||
if (file == NULL){
|
|
||||||
cw_log(LOG_ERR,"Cant open config file '%s': %s",
|
|
||||||
bootcfg.cfgfilename, strerror(errno));
|
|
||||||
exit(EXIT_FAILURE);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
/* create types tree with default types */
|
|
||||||
types_tree = cw_ktv_create_types_tree();
|
|
||||||
for (ti=CW_KTV_STD_TYPES;*ti;ti++){
|
|
||||||
mavl_insert_ptr(types_tree,*ti);
|
|
||||||
}
|
|
||||||
|
|
||||||
acglobal_cfg = cw_ktv_create();
|
|
||||||
if (acglobal_cfg == NULL){
|
|
||||||
cw_log(LOG_ERR,"Can't create local_cfg: %s",strerror(errno));
|
|
||||||
exit(EXIT_FAILURE);
|
|
||||||
}
|
|
||||||
|
|
||||||
cw_ktv_read_file(file,acglobal_cfg,types_tree);
|
|
||||||
|
|
||||||
fclose(file);
|
|
||||||
|
|
||||||
actube_global_cfg = acglobal_cfg;
|
|
||||||
|
|
||||||
|
|
||||||
cw_dbg_ktv_dump(acglobal_cfg,DBG_INFO,NULL,"CFG:",NULL);
|
|
||||||
|
|
||||||
|
|
||||||
cw_log_name = "AC-Tube";
|
cw_log_name = "AC-Tube";
|
||||||
|
|
||||||
if (!read_config ("ac.conf"))
|
/*
|
||||||
return 1;
|
|
||||||
|
{
|
||||||
|
int rc;
|
||||||
|
cw_Cfg_t * cfg = global_cfg;
|
||||||
|
struct cw_Cfg_entry e, *result;
|
||||||
|
|
||||||
|
e.key="hi";
|
||||||
|
|
||||||
|
rc = cw_cfg_base_exists(cfg,"ac-descriptor");
|
||||||
|
if (!rc ){
|
||||||
|
printf("No!\n");
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
printf("RESULT: %d\n",rc);
|
||||||
|
|
||||||
|
cw_cfg_set(tcfg,"tube.0","hallo");
|
||||||
|
cw_cfg_set(tcfg,"tube.1","welt");
|
||||||
|
cw_cfg_set(tcfg,"tube.2","der guten laune");
|
||||||
|
cw_cfg_dump(tcfg);
|
||||||
|
|
||||||
|
printf("Next Index: %d\n",cw_cfg_get_next_index(tcfg,"kinder"));
|
||||||
|
|
||||||
|
|
||||||
|
exit(0);
|
||||||
|
}
|
||||||
|
|
||||||
|
*/
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
start_shell();
|
start_shell();
|
||||||
|
|
||||||
|
|
||||||
/* Show debug options if there are any set */
|
|
||||||
if (cw_dbg_opt_level)
|
|
||||||
cw_log (LOG_INFO, "Debug Options: %08X", cw_dbg_opt_level);
|
|
||||||
|
|
||||||
/* XXX Hard coded debug settigns, set it by config in the future */
|
|
||||||
// cw_dbg_opt_display = DBG_DISP_ASC_DMP | DBG_DISP_COLORS;
|
|
||||||
|
|
||||||
/* Warn, if the "secret" debugging feature for
|
|
||||||
developers is turned on ;) */
|
|
||||||
|
|
||||||
/*
|
|
||||||
// DBGX("Attention! %s", "DBG X is ON!");
|
|
||||||
|
|
||||||
// cw_mod_set_mod_path("../../lib/actube");
|
|
||||||
//cw_mod_load("capwap");
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/* Init DTLS library */
|
/* Init DTLS library */
|
||||||
dtls_init();
|
dtls_init();
|
||||||
|
|
||||||
@ -322,15 +250,20 @@ int main (int argc, char *argv[])
|
|||||||
if (!dataman_list_init())
|
if (!dataman_list_init())
|
||||||
goto errX;
|
goto errX;
|
||||||
|
|
||||||
|
ac_conf_init(global_cfg);
|
||||||
|
|
||||||
|
cw_cfg_dump(global_cfg);
|
||||||
|
|
||||||
|
cw_log (LOG_INFO, "Starting AC-Tube, Name=%s, ID=%s", cw_cfg_get(global_cfg,"capwap/ac-name",NULL), conf_acid);
|
||||||
|
rc = ac_run(global_cfg);
|
||||||
|
|
||||||
cw_log (LOG_INFO, "Starting AC-Tube, Name=%s, ID=%s", conf_acname, conf_acid);
|
|
||||||
rc = ac_run();
|
|
||||||
errX:
|
errX:
|
||||||
if (global_cfg)
|
if (global_cfg)
|
||||||
mavl_destroy(global_cfg);
|
mavl_destroy(global_cfg);
|
||||||
|
|
||||||
|
if (discovery_cache)
|
||||||
|
discovery_cache_destroy(discovery_cache);
|
||||||
|
|
||||||
/* XXX There is more cleanup to do */
|
|
||||||
wtplist_destroy();
|
wtplist_destroy();
|
||||||
socklist_destroy();
|
socklist_destroy();
|
||||||
return rc;
|
return rc;
|
||||||
@ -339,21 +272,17 @@ errX:
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
void process_ctrl_packet (int index, struct sockaddr *addr, uint8_t * buffer, int len);
|
void process_ctrl_packet (int index, struct sockaddr *addr, uint8_t * buffer, int len);
|
||||||
|
|
||||||
void process_cw_data_packet (int index, struct sockaddr *addr, uint8_t * buffer, int len);
|
void process_cw_data_packet (int index, struct sockaddr *addr, uint8_t * buffer, int len);
|
||||||
|
|
||||||
|
|
||||||
int ac_run()
|
|
||||||
{
|
|
||||||
|
|
||||||
if (!conf_listen_addrs_len) {
|
int ac_run(cw_Cfg_t * cfg)
|
||||||
cw_log (LOG_ERR, "Fatal error: No listen addresses found.");
|
{
|
||||||
return 1;
|
struct cw_Cfg_iter cfi;
|
||||||
}
|
const char *s;
|
||||||
|
int i;
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
@ -362,16 +291,22 @@ int ac_run()
|
|||||||
* we will look for already created sockets to find a
|
* we will look for already created sockets to find a
|
||||||
* good unicast reply socket */
|
* good unicast reply socket */
|
||||||
|
|
||||||
int i;
|
cw_cfg_iter_init(cfg, &cfi, "actube/listen");
|
||||||
|
for (i=0; (s = cw_cfg_iter_next(&cfi, NULL)) != NULL; i++) {
|
||||||
|
|
||||||
for (i = 0; i < conf_listen_addrs_len; i++) {
|
|
||||||
char addr[100];
|
char addr[100];
|
||||||
char port[50];
|
char port[50];
|
||||||
int proto;
|
int proto;
|
||||||
|
|
||||||
conf_parse_listen_addr (conf_listen_addrs[i], addr, port, &proto);
|
conf_parse_listen_addr (s, addr, port, &proto);
|
||||||
|
socklist_add_unicast (addr, port, proto,
|
||||||
socklist_add_unicast (addr, port, proto);
|
cw_cfg_get_bool(cfg,"actube/ipv4","true"),
|
||||||
|
cw_cfg_get_bool(cfg,"actube/ipv6","true")
|
||||||
|
);
|
||||||
|
}
|
||||||
|
if (!i) {
|
||||||
|
cw_log (LOG_ERR, "Fatal error: No listen addresses found.");
|
||||||
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (socklist_len == 0) {
|
if (socklist_len == 0) {
|
||||||
@ -379,6 +314,9 @@ int ac_run()
|
|||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/* create multicast sockets */
|
/* create multicast sockets */
|
||||||
for (i = 0; i < conf_mcast_groups_len; i++) {
|
for (i = 0; i < conf_mcast_groups_len; i++) {
|
||||||
|
|
||||||
@ -395,13 +333,20 @@ int ac_run()
|
|||||||
}
|
}
|
||||||
|
|
||||||
/* broadcast socket ipv4 only */
|
/* broadcast socket ipv4 only */
|
||||||
for (i = 0; i < conf_bcast_addrs_len; i++) {
|
|
||||||
|
//mavl_print(cfg,pcb,180);
|
||||||
|
|
||||||
|
cw_cfg_iter_init(cfg, &cfi, "actube/bcast");
|
||||||
|
for (i=0; (s = cw_cfg_iter_next(&cfi, NULL)) != NULL; i++) {
|
||||||
|
// for (i = 0; i < conf_bcast_addrs_len; i++) {
|
||||||
|
|
||||||
char addr[50], port[50];
|
char addr[50], port[50];
|
||||||
int proto;
|
int proto;
|
||||||
conf_parse_listen_addr (conf_bcast_addrs[i], addr, port, &proto);
|
conf_parse_listen_addr (s, addr, port, &proto);
|
||||||
|
|
||||||
socklist_add_broadcast (addr, port, proto);
|
socklist_add_broadcast (addr, port, proto);
|
||||||
|
|
||||||
|
|
||||||
#ifdef WITH_LWAPP
|
#ifdef WITH_LWAPP
|
||||||
|
|
||||||
// printf("Adding %d\n",socklist_len);
|
// printf("Adding %d\n",socklist_len);
|
||||||
@ -517,7 +462,7 @@ void process_cw_data_packet (int index, struct sockaddr *addr, uint8_t * buffer,
|
|||||||
|
|
||||||
dataman_list_unlock();
|
dataman_list_unlock();
|
||||||
|
|
||||||
dataman_add_packet (dm, buffer, len);
|
//dataman_add_packet (dm, buffer, len);
|
||||||
|
|
||||||
return;
|
return;
|
||||||
|
|
||||||
@ -561,7 +506,7 @@ void process_cw_ctrl_packet (int index, struct sockaddr *addr, uint8_t * buffer,
|
|||||||
|
|
||||||
if (!wtpman) {
|
if (!wtpman) {
|
||||||
|
|
||||||
wtpman = wtpman_create (index, addr, preamble & 0xf);
|
wtpman = wtpman_create (index, addr, preamble & 0xf, global_cfg);
|
||||||
|
|
||||||
|
|
||||||
if (!wtpman) {
|
if (!wtpman) {
|
||||||
@ -581,6 +526,7 @@ void process_cw_ctrl_packet (int index, struct sockaddr *addr, uint8_t * buffer,
|
|||||||
wtpman_start (wtpman, preamble & 0xf);
|
wtpman_start (wtpman, preamble & 0xf);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
//printf("Got Packet with len: %d\n",len);
|
||||||
|
|
||||||
wtpman_addpacket (wtpman, buffer, len);
|
wtpman_addpacket (wtpman, buffer, len);
|
||||||
wtplist_unlock();
|
wtplist_unlock();
|
||||||
|
368
src/ac/conf.c
368
src/ac/conf.c
@ -19,7 +19,6 @@
|
|||||||
#include <string.h>
|
#include <string.h>
|
||||||
#include <sys/utsname.h>
|
#include <sys/utsname.h>
|
||||||
|
|
||||||
#include <confuse.h>
|
|
||||||
|
|
||||||
#include "cw/capwap.h"
|
#include "cw/capwap.h"
|
||||||
#include "cw/sock.h"
|
#include "cw/sock.h"
|
||||||
@ -36,12 +35,13 @@
|
|||||||
|
|
||||||
#include "conf.h"
|
#include "conf.h"
|
||||||
#include "ac.h"
|
#include "ac.h"
|
||||||
|
#include "cw/cfg.h"
|
||||||
|
|
||||||
#include "cw/mavltypes.h"
|
#include "cw/mavltypes.h"
|
||||||
|
|
||||||
uint8_t conf_macaddress[12];
|
/*uint8_t conf_macaddress[12];
|
||||||
uint8_t conf_macaddress_len = 0;
|
uint8_t conf_macaddress_len = 0;
|
||||||
|
*/
|
||||||
|
|
||||||
long conf_strict_capwap = 1;
|
long conf_strict_capwap = 1;
|
||||||
long conf_strict_headers = 0;
|
long conf_strict_headers = 0;
|
||||||
@ -49,9 +49,6 @@ long conf_strict_headers = 0;
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
const char *conf_acname = NULL;
|
|
||||||
int conf_acname_len = 0;
|
|
||||||
|
|
||||||
char *conf_acid = NULL;
|
char *conf_acid = NULL;
|
||||||
|
|
||||||
char *conf_primary_if = NULL;
|
char *conf_primary_if = NULL;
|
||||||
@ -60,16 +57,11 @@ long conf_max_wtps = CONF_DEFAULT_MAXWTPS;
|
|||||||
char *conf_logfilename = CONF_DEFAULT_LOGFILENAME;
|
char *conf_logfilename = CONF_DEFAULT_LOGFILENAME;
|
||||||
struct sockaddr_storage *conf_salist = NULL;
|
struct sockaddr_storage *conf_salist = NULL;
|
||||||
|
|
||||||
char **conf_listen_addrs;
|
|
||||||
int conf_listen_addrs_len = 0;
|
|
||||||
|
|
||||||
|
|
||||||
char **conf_mcast_groups = 0;
|
char **conf_mcast_groups = 0;
|
||||||
int conf_mcast_groups_len = 0;
|
int conf_mcast_groups_len = 0;
|
||||||
|
|
||||||
char **conf_bcast_addrs = 0;
|
|
||||||
int conf_bcast_addrs_len;
|
|
||||||
|
|
||||||
|
|
||||||
struct sockaddr_storage *conf_bsalist = NULL;
|
struct sockaddr_storage *conf_bsalist = NULL;
|
||||||
|
|
||||||
@ -120,14 +112,45 @@ char *conf_control_port = 0;
|
|||||||
|
|
||||||
int conf_dtls_verify_peer = 1;
|
int conf_dtls_verify_peer = 1;
|
||||||
|
|
||||||
static int init_acname()
|
static int init_ac_name(cw_Cfg_t * cfg)
|
||||||
{
|
{
|
||||||
if (conf_acname == NULL) {
|
char *s;
|
||||||
char *s = malloc(strlen(CONF_DEFAULT_ACNAME) + strlen(conf_acid) + 1);
|
char *primary_if=NULL;
|
||||||
sprintf(s, "%s%s", CONF_DEFAULT_ACNAME, conf_acid);
|
char ac_name[CAPWAP_MAX_AC_NAME_LEN+1];
|
||||||
conf_acname = s;
|
uint8_t macaddress[128];
|
||||||
|
uint8_t macaddress_len;
|
||||||
|
char acid[128];
|
||||||
|
int i;
|
||||||
|
|
||||||
|
|
||||||
|
s= cw_cfg_get(cfg,"capwap/ac-name",NULL);
|
||||||
|
if (s!=NULL)
|
||||||
|
return 1;
|
||||||
|
|
||||||
|
// primary_if = sock_get_primary_if(AF_INET6);
|
||||||
|
if (!primary_if)
|
||||||
|
primary_if = sock_get_primary_if(AF_INET);
|
||||||
|
|
||||||
|
acid[0]=0;
|
||||||
|
|
||||||
|
if (primary_if) {
|
||||||
|
macaddress_len=8;
|
||||||
|
if (!sock_getifhwaddr(primary_if, macaddress, &macaddress_len)) {
|
||||||
|
cw_dbg(DBG_INFO, "Fatal: Unable to detect link layer address for %s\n",
|
||||||
|
primary_if);
|
||||||
|
}
|
||||||
|
else{
|
||||||
|
s=acid;
|
||||||
|
for (i = 0; i < macaddress_len; i++) {
|
||||||
|
s += sprintf(s, "%02X", macaddress[i]);
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
|
free(primary_if);
|
||||||
}
|
}
|
||||||
conf_acname_len = strlen(conf_acname);
|
|
||||||
|
sprintf(ac_name,"actube%s",acid);
|
||||||
|
cw_cfg_set(cfg,"capwap/ac-name",ac_name);
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -136,49 +159,6 @@ static int init_acname()
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
static int init_acid()
|
|
||||||
{
|
|
||||||
int i;
|
|
||||||
char *s;
|
|
||||||
|
|
||||||
if (conf_acid != NULL)
|
|
||||||
return 1;
|
|
||||||
|
|
||||||
|
|
||||||
#ifdef WITH_IPV6
|
|
||||||
conf_primary_if = sock_get_primary_if(AF_INET6);
|
|
||||||
if (!conf_primary_if)
|
|
||||||
conf_primary_if = sock_get_primary_if(AF_INET);
|
|
||||||
#else
|
|
||||||
conf_primary_if = get_primary_if(AF_INET);
|
|
||||||
#endif
|
|
||||||
|
|
||||||
if (!conf_primary_if) {
|
|
||||||
cw_log(LOG_ERR,
|
|
||||||
"Fatal: Unable to detect primary interface, needed to set ac_id. Pleas use confiPleas u to set ac_id");
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (!sock_getifhwaddr(conf_primary_if, conf_macaddress, &conf_macaddress_len)) {
|
|
||||||
cw_log(LOG_ERR, "Fatal: Unable to detect link layer address for %s\n",
|
|
||||||
conf_primary_if);
|
|
||||||
return 0;
|
|
||||||
};
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
conf_acid = malloc(2 * conf_macaddress_len + 1);
|
|
||||||
s = conf_acid;
|
|
||||||
|
|
||||||
for (i = 0; i < conf_macaddress_len; i++) {
|
|
||||||
s += sprintf(s, "%02X", conf_macaddress[i]);
|
|
||||||
}
|
|
||||||
return 1;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
static int init_dtls()
|
static int init_dtls()
|
||||||
{
|
{
|
||||||
if (conf_dtls_psk != NULL) {
|
if (conf_dtls_psk != NULL) {
|
||||||
@ -215,41 +195,25 @@ static int init_control_port()
|
|||||||
|
|
||||||
#include <ifaddrs.h>
|
#include <ifaddrs.h>
|
||||||
|
|
||||||
static int init_listen_addrs()
|
static int init_listen_addrs(cw_Cfg_t * cfg)
|
||||||
{
|
{
|
||||||
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
|
|
||||||
struct ifaddrs *ifap, *ifa;
|
struct ifaddrs *ifap, *ifa;
|
||||||
int rc;
|
int rc;
|
||||||
int ctr;
|
int ctr;
|
||||||
|
struct cw_Cfg_iter cfi;
|
||||||
if (conf_listen_addrs != 0)
|
|
||||||
return 1;
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
cw_cfg_iter_init(cfg, &cfi, "actube/listen");
|
||||||
|
if (cw_cfg_iter_next(&cfi,NULL) != NULL)
|
||||||
|
return 0;
|
||||||
|
|
||||||
rc = getifaddrs(&ifap);
|
rc = getifaddrs(&ifap);
|
||||||
if (rc == -1)
|
if (rc == -1)
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
/* count the addresses */
|
|
||||||
ctr = 0;
|
|
||||||
for (ifa = ifap; ifa != 0; ifa = ifa->ifa_next) {
|
|
||||||
if (!ifa->ifa_addr)
|
|
||||||
continue;
|
|
||||||
|
|
||||||
if (ifa->ifa_addr->sa_family == AF_INET && conf_ipv4)
|
|
||||||
ctr++;
|
|
||||||
if (ifa->ifa_addr->sa_family == AF_INET6 && conf_ipv6)
|
|
||||||
ctr++;
|
|
||||||
}
|
|
||||||
|
|
||||||
conf_listen_addrs = malloc(sizeof(char *) * ctr);
|
|
||||||
if (!conf_listen_addrs) {
|
|
||||||
rc = 0;
|
|
||||||
goto errX;
|
|
||||||
}
|
|
||||||
memset(conf_listen_addrs, 0, sizeof(char *) * ctr);
|
|
||||||
|
|
||||||
|
|
||||||
ctr = 0;
|
ctr = 0;
|
||||||
/* get the addresses */
|
/* get the addresses */
|
||||||
for (ifa = ifap; ifa != 0; ifa = ifa->ifa_next) {
|
for (ifa = ifap; ifa != 0; ifa = ifa->ifa_next) {
|
||||||
@ -267,12 +231,9 @@ static int init_listen_addrs()
|
|||||||
if (ifa->ifa_addr->sa_family == AF_INET && conf_ipv4) {
|
if (ifa->ifa_addr->sa_family == AF_INET && conf_ipv4) {
|
||||||
sock_addrtostr(ifa->ifa_addr, str, 100,0);
|
sock_addrtostr(ifa->ifa_addr, str, 100,0);
|
||||||
|
|
||||||
conf_listen_addrs[ctr] =
|
|
||||||
(char *) cw_setstr((uint8_t **) & conf_listen_addrs[ctr],
|
|
||||||
(uint8_t *) str, strlen(str));
|
|
||||||
if (conf_listen_addrs[ctr])
|
|
||||||
ctr++;
|
|
||||||
|
|
||||||
|
sprintf(key,"actube/listen.%d",ctr++);
|
||||||
|
cw_cfg_set(cfg,key,str);
|
||||||
}
|
}
|
||||||
if (ifa->ifa_addr->sa_family == AF_INET6 && conf_ipv6) {
|
if (ifa->ifa_addr->sa_family == AF_INET6 && conf_ipv6) {
|
||||||
sock_addrtostr(ifa->ifa_addr, str, 100,0);
|
sock_addrtostr(ifa->ifa_addr, str, 100,0);
|
||||||
@ -281,14 +242,10 @@ static int init_listen_addrs()
|
|||||||
strcat(str, "%");
|
strcat(str, "%");
|
||||||
strcat(str, ifa->ifa_name);
|
strcat(str, ifa->ifa_name);
|
||||||
}
|
}
|
||||||
conf_listen_addrs[ctr] =
|
sprintf(key,"actube/listen.%d",ctr++);
|
||||||
(char *) cw_setstr((uint8_t **) & conf_listen_addrs[ctr],
|
cw_cfg_set(cfg,key,str);
|
||||||
(uint8_t *) str, strlen(str));
|
|
||||||
if (conf_listen_addrs[ctr])
|
|
||||||
ctr++;
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
conf_listen_addrs_len = ctr;
|
|
||||||
rc = 1;
|
rc = 1;
|
||||||
errX:
|
errX:
|
||||||
freeifaddrs(ifap);
|
freeifaddrs(ifap);
|
||||||
@ -336,18 +293,24 @@ static int add_bcast_addr(void *priv, void *addr)
|
|||||||
/*
|
/*
|
||||||
* Initialize broadcast addresses (ipv4 only)
|
* Initialize broadcast addresses (ipv4 only)
|
||||||
*/
|
*/
|
||||||
int init_bcast_addrs()
|
int init_bcast_addrs(cw_Cfg_t *cfg)
|
||||||
{
|
{
|
||||||
int rc;
|
int rc;
|
||||||
char str[100];
|
char str[100];
|
||||||
|
char key[100];
|
||||||
struct ifaddrs *ifa0, *ifa;
|
struct ifaddrs *ifa0, *ifa;
|
||||||
mavl_t t;
|
mavl_t t;
|
||||||
mavliter_t it;
|
mavliter_t it;
|
||||||
|
struct cw_Cfg_iter cfi;
|
||||||
|
int i;
|
||||||
|
|
||||||
if (conf_bcast_addrs)
|
//printf("BCAST INIT\n");
|
||||||
return 1;
|
cw_cfg_iter_init(cfg, &cfi, "actube/bcast");
|
||||||
|
if (cw_cfg_iter_next(&cfi,NULL) != NULL)
|
||||||
|
return 0;
|
||||||
|
|
||||||
if (!conf_ipv4)
|
|
||||||
|
if (!cw_cfg_get_bool(cfg,"actube/ipv4", "true"))
|
||||||
return 1;
|
return 1;
|
||||||
|
|
||||||
/*t = mavl_create_ptr(); */
|
/*t = mavl_create_ptr(); */
|
||||||
@ -385,22 +348,34 @@ int init_bcast_addrs()
|
|||||||
|
|
||||||
|
|
||||||
if (ifa->ifa_broadaddr) {
|
if (ifa->ifa_broadaddr) {
|
||||||
|
char *s,*sr;
|
||||||
sock_addrtostr(ifa->ifa_broadaddr, str, 100,1);
|
sock_addrtostr(ifa->ifa_broadaddr, str, 100,1);
|
||||||
*strchr(str, ':') = 0;
|
*strchr(str, ':') = 0;
|
||||||
mavl_add_str(t, cw_strdup(str));
|
|
||||||
|
|
||||||
|
s = cw_strdup(str);
|
||||||
|
sr = mavl_add_str(t, s);
|
||||||
|
|
||||||
|
|
||||||
|
printf("BCAST = %p --- %p: %s\n",str,s,str);
|
||||||
}
|
}
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
conf_bcast_addrs = malloc(t->count * sizeof(char *));
|
// conf_bcast_addrs = malloc(t->count * sizeof(char *));
|
||||||
|
|
||||||
|
i=0;
|
||||||
mavliter_init(&it,t);
|
mavliter_init(&it,t);
|
||||||
mavliter_foreach(&it){
|
mavliter_foreach(&it){
|
||||||
char * d;
|
char * d;
|
||||||
d = mavliter_get_str(&it);
|
d = mavliter_get_str(&it);
|
||||||
conf_bcast_addrs[conf_bcast_addrs_len] = cw_strdup(d);
|
// conf_bcast_addrs[conf_bcast_addrs_len] = cw_strdup(d);
|
||||||
if (conf_bcast_addrs[conf_bcast_addrs_len] != 0)
|
// if (conf_bcast_addrs[conf_bcast_addrs_len] != 0)
|
||||||
conf_bcast_addrs_len++;
|
// conf_bcast_addrs_len++;
|
||||||
|
|
||||||
|
sprintf(key,"actube/bcast.%d",i++);
|
||||||
|
cw_cfg_set(cfg,key,d);
|
||||||
|
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -412,7 +387,7 @@ int init_bcast_addrs()
|
|||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
int init_mcast_groups()
|
int init_mcast_groups(cw_Cfg_t * cfg)
|
||||||
{
|
{
|
||||||
int ctr;
|
int ctr;
|
||||||
int i;
|
int i;
|
||||||
@ -466,6 +441,7 @@ int init_mcast_groups()
|
|||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
static int conf_read_strings(cfg_t * cfg, char *name, char ***dst, int *len)
|
static int conf_read_strings(cfg_t * cfg, char *name, char ***dst, int *len)
|
||||||
{
|
{
|
||||||
|
|
||||||
@ -491,8 +467,9 @@ static int conf_read_strings(cfg_t * cfg, char *name, char ***dst, int *len)
|
|||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
*/
|
||||||
|
|
||||||
|
/*
|
||||||
static int conf_read_dbg_level(cfg_t * cfg)
|
static int conf_read_dbg_level(cfg_t * cfg)
|
||||||
{
|
{
|
||||||
const char *name = "dbg";
|
const char *name = "dbg";
|
||||||
@ -510,6 +487,7 @@ static int conf_read_dbg_level(cfg_t * cfg)
|
|||||||
}
|
}
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
*/
|
||||||
|
|
||||||
struct cw_Mod ** conf_mods;
|
struct cw_Mod ** conf_mods;
|
||||||
char *conf_mods_dir = NULL;
|
char *conf_mods_dir = NULL;
|
||||||
@ -517,19 +495,28 @@ char *conf_mods_dir = NULL;
|
|||||||
/*
|
/*
|
||||||
* Read the module names from config file
|
* Read the module names from config file
|
||||||
*/
|
*/
|
||||||
static int conf_read_mods(cfg_t *cfg){
|
static int init_mods(cw_Cfg_t *cfg){
|
||||||
|
|
||||||
int n, i;
|
int n, i;
|
||||||
n = cfg_size(cfg,CFG_ENTRY_MODS);
|
const char * modname;
|
||||||
|
|
||||||
conf_mods = malloc(sizeof(struct cw_Mod *)*(n+1));
|
struct cw_Cfg_iter cfi;
|
||||||
|
cw_cfg_iter_init(cfg, &cfi, "actube/mod");
|
||||||
|
if (cw_cfg_iter_next(&cfi,NULL) == NULL){
|
||||||
|
cw_cfg_set(cfg,"actube/mod.0","capwap");
|
||||||
|
cw_cfg_set(cfg,"actube/mod.1","capwap80211");
|
||||||
|
}
|
||||||
|
|
||||||
cw_dbg(DBG_INFO,"Mods directory: %s",conf_mods_dir);
|
// cw_dbg(DBG_INFO,"Mods directory: %s",conf_mods_dir);
|
||||||
cw_mod_set_path(conf_mods_dir);
|
// cw_mod_set_path(conf_mods_dir);
|
||||||
|
|
||||||
for (i=0; i < n; i++){
|
cw_cfg_iter_init(cfg, &cfi, "actube/mod");
|
||||||
char *modname = cfg_getnstr(cfg, CFG_ENTRY_MODS, i);
|
printf("iter mods\n");
|
||||||
struct cw_Mod * mod = cw_mod_load(modname, actube_global_cfg, CW_ROLE_AC);
|
for (i=0; (modname = cw_cfg_iter_next(&cfi, NULL)) != NULL; i++) {
|
||||||
|
|
||||||
|
printf("init mod name: %s\n",modname);
|
||||||
|
|
||||||
|
struct cw_Mod * mod = cw_mod_load(modname, cfg, CW_ROLE_AC);
|
||||||
|
|
||||||
if (!mod)
|
if (!mod)
|
||||||
return 0;
|
return 0;
|
||||||
@ -630,148 +617,19 @@ static void errfunc(cfg_t *cfg, const char *fmt, va_list ap){
|
|||||||
fprintf(stderr,"\n");
|
fprintf(stderr,"\n");
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
int read_config(const char *filename)
|
|
||||||
{
|
|
||||||
int i, n;
|
|
||||||
|
|
||||||
cfg_opt_t opts[] = {
|
|
||||||
CFG_STR_LIST("mods", "{}", CFGF_NONE),
|
|
||||||
CFG_SIMPLE_STR("mods_dir", &conf_mods_dir),
|
|
||||||
|
|
||||||
CFG_STR_LIST("dbg", "{}", CFGF_NONE),
|
|
||||||
CFG_STR_LIST("listen", "{}", CFGF_NONE),
|
|
||||||
CFG_STR_LIST("mcast_groups", "{}", CFGF_NONE),
|
|
||||||
CFG_STR_LIST("broadcast_listen", "{}", CFGF_NONE),
|
|
||||||
CFG_STR_LIST("ac_ips", "{}", CFGF_NONE),
|
|
||||||
CFG_SIMPLE_STR("control_port", &conf_control_port),
|
|
||||||
|
|
||||||
CFG_SIMPLE_BOOL("strict_capwap", &conf_strict_capwap),
|
|
||||||
CFG_SIMPLE_BOOL("strict_headers", &conf_strict_headers),
|
|
||||||
CFG_SIMPLE_BOOL("use_loopback", &conf_use_loopback),
|
|
||||||
/*// CFG_SIMPLE_STR("capwap_mode", &conf_capwap_mode_str),*/
|
|
||||||
|
|
||||||
|
|
||||||
#ifdef WITH_LWAPP
|
|
||||||
CFG_SIMPLE_STR("lw_control_port", &conf_lw_control_port),
|
|
||||||
CFG_SIMPLE_BOOL("lwapp", &conf_lwapp),
|
|
||||||
#endif
|
|
||||||
|
|
||||||
CFG_SIMPLE_INT("max_wtps", &conf_max_wtps),
|
|
||||||
CFG_SIMPLE_INT("debug_level", &conf_debug_level),
|
|
||||||
|
|
||||||
|
|
||||||
CFG_SIMPLE_INT("vendor_id", &conf_vendor_id),
|
|
||||||
CFG_SIMPLE_STR("ac_id", &conf_acid),
|
|
||||||
CFG_SIMPLE_STR("ac_name", &conf_acname),
|
|
||||||
CFG_SIMPLE_STR("hardware_version", &conf_hardware_version),
|
|
||||||
CFG_SIMPLE_STR("software_version", &conf_software_version),
|
|
||||||
|
|
||||||
CFG_SIMPLE_STR("cisco_hardware_version", &conf_cisco_hardware_version),
|
|
||||||
CFG_SIMPLE_STR("cisco_software_version", &conf_cisco_software_version),
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
CFG_SIMPLE_STR("ssl_cert", &conf_sslcertfilename),
|
|
||||||
CFG_SIMPLE_STR("ssl_key", &conf_sslkeyfilename),
|
|
||||||
CFG_SIMPLE_STR("ssl_key_pass", &conf_sslkeypass),
|
|
||||||
CFG_SIMPLE_STR("dtls_psk", &conf_dtls_psk),
|
|
||||||
|
|
||||||
CFG_SIMPLE_BOOL("dtls_verify_peer", &conf_dtls_verify_peer),
|
|
||||||
CFG_SIMPLE_BOOL("ipv4", &conf_ipv4),
|
|
||||||
CFG_SIMPLE_BOOL("ipv6", &conf_ipv6),
|
|
||||||
CFG_SIMPLE_STR("db_file", &conf_db_file),
|
|
||||||
CFG_SIMPLE_STR("image_dir", &conf_image_dir),
|
|
||||||
|
|
||||||
CFG_END()
|
|
||||||
};
|
|
||||||
cfg_t *cfg;
|
|
||||||
|
|
||||||
conf_mods_dir=cw_strdup("");
|
|
||||||
|
|
||||||
if (!init_control_port())
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
|
|
||||||
cfg = cfg_init(opts, CFGF_NONE);
|
|
||||||
cfg_set_error_function(cfg, errfunc);
|
|
||||||
|
|
||||||
if (cfg_parse(cfg, filename))
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
|
|
||||||
/* read debug options */
|
|
||||||
conf_read_dbg_level(cfg);
|
|
||||||
|
|
||||||
/* read the listen addresses */
|
|
||||||
conf_read_strings(cfg, "listen", &conf_listen_addrs, &conf_listen_addrs_len);
|
|
||||||
|
|
||||||
/* read multi cast groups */
|
|
||||||
conf_read_strings(cfg, "mcast_groups", &conf_mcast_groups,
|
|
||||||
&conf_mcast_groups_len);
|
|
||||||
|
|
||||||
/* read ipv4 broadcast addresses */
|
|
||||||
conf_read_strings(cfg, "broadcast_listen", &conf_bcast_addrs, &conf_bcast_addrs_len);
|
|
||||||
|
|
||||||
|
|
||||||
/* read ac_ips */
|
|
||||||
n = cfg_size(cfg, "ac_ips");
|
|
||||||
if (!(conf_ac_ips = malloc(sizeof(struct sockaddr) * n)))
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
conf_ac_ips_len = n;
|
|
||||||
for (i = 0; i < n; i++) {
|
|
||||||
struct sockaddr sa;
|
|
||||||
char *str = cfg_getnstr(cfg, "ac_ips", i);
|
|
||||||
if (sock_strtoaddr(cfg_getnstr(cfg, "ac_ips", i), &sa))
|
|
||||||
conf_ac_ips[i] = sa;
|
|
||||||
else {
|
|
||||||
perror(str);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
if (!conf_read_mods(cfg)){
|
|
||||||
cfg_free(cfg);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
cfg_free(cfg);
|
|
||||||
|
|
||||||
if (!init_acid())
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
if (!init_acname())
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
/* if (!init_version())
|
|
||||||
return 0;
|
|
||||||
*/
|
|
||||||
|
|
||||||
if (!init_vendor_id())
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
if (!init_dtls())
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
/* if (!conf_sslcipher)
|
|
||||||
conf_sslcipher = CAPWAP_CIPHER;
|
|
||||||
|
|
||||||
*/ if (!conf_image_dir)
|
|
||||||
conf_image_dir = CONF_DEFAULT_IMAGE_DIR;
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
init_listen_addrs();
|
|
||||||
init_mcast_groups();
|
|
||||||
init_bcast_addrs();
|
|
||||||
|
|
||||||
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
void free_config()
|
void free_config()
|
||||||
{
|
{
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
void ac_conf_init(cw_Cfg_t *cfg)
|
||||||
|
{
|
||||||
|
printf("ac conf\n");
|
||||||
|
init_listen_addrs(cfg);
|
||||||
|
init_bcast_addrs(cfg);
|
||||||
|
init_ac_name(cfg);
|
||||||
|
init_mods(cfg);
|
||||||
|
}
|
||||||
|
@ -31,7 +31,7 @@
|
|||||||
#include "cw/bstr.h"
|
#include "cw/bstr.h"
|
||||||
#include "cw/mod.h"
|
#include "cw/mod.h"
|
||||||
#include "cw/vendors.h"
|
#include "cw/vendors.h"
|
||||||
|
#include "cw/cfg.h"
|
||||||
|
|
||||||
extern struct cw_Mod ** conf_mods;
|
extern struct cw_Mod ** conf_mods;
|
||||||
|
|
||||||
@ -94,8 +94,6 @@ extern bstr_t conf_cisco_software_version;
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
extern char **conf_listen_addrs;
|
|
||||||
extern int conf_listen_addrs_len;
|
|
||||||
|
|
||||||
extern struct sockaddr *conf_ac_ips;
|
extern struct sockaddr *conf_ac_ips;
|
||||||
extern int conf_ac_ips_len;
|
extern int conf_ac_ips_len;
|
||||||
@ -141,5 +139,8 @@ extern int conf_parse_listen_addr(const char *addr, char *saddr, char *port, int
|
|||||||
|
|
||||||
#define CFG_ENTRY_MODS "mods"
|
#define CFG_ENTRY_MODS "mods"
|
||||||
|
|
||||||
|
#define CONF_PREFIX "actube"
|
||||||
|
|
||||||
|
void ac_conf_init(cw_Cfg_t *cfg);
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
69
src/ac/config.ckv
Normal file
69
src/ac/config.ckv
Normal file
@ -0,0 +1,69 @@
|
|||||||
|
#Cfg
|
||||||
|
|
||||||
|
#
|
||||||
|
# AC Name
|
||||||
|
# Deafults to actube + mac address of primary interface
|
||||||
|
#
|
||||||
|
#capwap/ac-name
|
||||||
|
#
|
||||||
|
capwap/ac-name: actube
|
||||||
|
|
||||||
|
capwap/ssl-cipher: DHE-RSA:RSA:AES-256-CBC:AES-128-CBC:SHA1:PSK
|
||||||
|
capwap/ssl-psk-enable: false
|
||||||
|
capwap/ssl-psk: 123456
|
||||||
|
capwap/ssl-dhbits: 1024
|
||||||
|
|
||||||
|
cisco/ssl-keyfile: "../../ssl/intermediate-ca/int-ca.key"
|
||||||
|
cisco/ssl-certfile: "../../ssl/intermediate-ca/int-ca.crt"
|
||||||
|
cisco/ssl-cipher: DEFAULT
|
||||||
|
cisco/ssl-dhbits: 2048
|
||||||
|
|
||||||
|
|
||||||
|
#
|
||||||
|
# Whether or not to use IPv4/IPv6
|
||||||
|
#
|
||||||
|
#actube/ipv4: true
|
||||||
|
#actube/ipv6: true
|
||||||
|
#
|
||||||
|
actube/ipv6: false
|
||||||
|
|
||||||
|
#
|
||||||
|
# List of Mods
|
||||||
|
#
|
||||||
|
#actube/mod.1: capwap
|
||||||
|
#actube/mod.2: capwap80211
|
||||||
|
#
|
||||||
|
|
||||||
|
actube/mod.0: cisco
|
||||||
|
actube/mod.1: capwap
|
||||||
|
actube/mod.2: capwap80211
|
||||||
|
|
||||||
|
|
||||||
|
ac-descriptor/dtls-policy: 1
|
||||||
|
ac-descriptor/hardware/vendor: 4232704
|
||||||
|
ac-descriptor/hardware/version: .x01000001
|
||||||
|
ac-descriptor/max-wtps : 200
|
||||||
|
ac-descriptor/active-wtps: 2
|
||||||
|
ac-descriptor/r-mac-field: 1
|
||||||
|
ac-descriptor/reserved1 : 0
|
||||||
|
ac-descriptor/security : 2
|
||||||
|
ac-descriptor/software/vendor : 0
|
||||||
|
ac-descriptor/software/version: v0.0.1
|
||||||
|
ac-descriptor/station-limit: 1000
|
||||||
|
ac-descriptor/stations: 0
|
||||||
|
|
||||||
|
|
||||||
|
capwap-control-ip-address/address.0: 192.168.0.14
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
#
|
||||||
|
# CAPWAP Timers
|
||||||
|
#
|
||||||
|
capwap-timers/change-state-pending-timer: Word: 3
|
||||||
|
capwap-timers/data-check-timer: Word: 10
|
||||||
|
capwap-timers/echo-interval :Byte: 30
|
||||||
|
capwap-timers/max-discovery-interval :Byte: 10
|
||||||
|
|
||||||
|
|
||||||
|
|
@ -4,6 +4,7 @@
|
|||||||
#include "cw/mlist.h"
|
#include "cw/mlist.h"
|
||||||
#include "mavl.h"
|
#include "mavl.h"
|
||||||
#include "cw/mod.h"
|
#include "cw/mod.h"
|
||||||
|
#include "cw/dbg.h"
|
||||||
|
|
||||||
#include "discovery_cache.h"
|
#include "discovery_cache.h"
|
||||||
struct cw_DiscoveryCacheElem{
|
struct cw_DiscoveryCacheElem{
|
||||||
@ -32,6 +33,9 @@ void discovery_cache_destroy(struct cw_DiscoveryCache * c)
|
|||||||
if (c->byaddrp)
|
if (c->byaddrp)
|
||||||
mavl_destroy(c->byaddrp);
|
mavl_destroy(c->byaddrp);
|
||||||
|
|
||||||
|
if (c->queue)
|
||||||
|
free(c->queue);
|
||||||
|
|
||||||
free(c);
|
free(c);
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -105,13 +109,23 @@ errX:
|
|||||||
void discovery_cache_add(struct cw_DiscoveryCache *cache,
|
void discovery_cache_add(struct cw_DiscoveryCache *cache,
|
||||||
struct sockaddr * addr, struct cw_Mod * mod_capwap, struct cw_Mod * mod_bindings)
|
struct sockaddr * addr, struct cw_Mod * mod_capwap, struct cw_Mod * mod_bindings)
|
||||||
{
|
{
|
||||||
|
|
||||||
|
{
|
||||||
|
cw_dbg(DBG_X,"////////////////////////// ADDD CAHCE ///////////////////////");
|
||||||
|
char str[128];
|
||||||
|
sock_addrtostr(addr,str,128,1);
|
||||||
|
printf("Add addr: %s\n",str);
|
||||||
|
}
|
||||||
|
|
||||||
struct cw_DiscoveryCacheElem * cur = cache->queue+cache->qpos;
|
struct cw_DiscoveryCacheElem * cur = cache->queue+cache->qpos;
|
||||||
if (cur->cmod!=NULL){
|
if (cur->cmod!=NULL){
|
||||||
/* delete here */
|
/* delete here */
|
||||||
|
|
||||||
|
cw_dbg(DBG_X,"DOIN MAVL DEL ----- ///////////");
|
||||||
|
|
||||||
void * ptr = &cur;
|
void * ptr = &cur;
|
||||||
mavl_del(cache->byaddr,ptr);
|
mavl_del(cache->byaddr,ptr);
|
||||||
mavl_del(cache->byaddr,ptr);
|
mavl_del(cache->byaddrp,ptr);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
cur->cmod=mod_capwap;
|
cur->cmod=mod_capwap;
|
||||||
@ -141,9 +155,24 @@ int discovery_cache_get(struct cw_DiscoveryCache * cache,struct sockaddr *addr,
|
|||||||
sock_copyaddr(&search.addr,addr);
|
sock_copyaddr(&search.addr,addr);
|
||||||
search.ctrhi=search.ctrlo=0;
|
search.ctrhi=search.ctrlo=0;
|
||||||
|
|
||||||
|
{
|
||||||
|
cw_dbg(DBG_X,"DISCOVERY CACHE ---------------------------- GET ENTER");
|
||||||
|
char str[128];
|
||||||
|
sock_addrtostr(addr,str,128,1);
|
||||||
|
printf("Add addr: %s\n",str);
|
||||||
|
}
|
||||||
|
|
||||||
search_ptr = &search;
|
search_ptr = &search;
|
||||||
result = mavl_get(cache->byaddrp ,&search_ptr);
|
result = mavl_get(cache->byaddrp ,&search_ptr);
|
||||||
if (result != NULL){
|
if (result != NULL){
|
||||||
|
{
|
||||||
|
cw_dbg(DBG_X,"DISCOVERY CACHE ---------------------------- FOUND 1 with Port");
|
||||||
|
char str[128];
|
||||||
|
sock_addrtostr(addr,str,128,1);
|
||||||
|
printf("Add addr: %s\n",str);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
elem = *result;
|
elem = *result;
|
||||||
if (elem != NULL){
|
if (elem != NULL){
|
||||||
mavl_del(cache->byaddr,result);
|
mavl_del(cache->byaddr,result);
|
||||||
@ -163,14 +192,37 @@ int discovery_cache_get(struct cw_DiscoveryCache * cache,struct sockaddr *addr,
|
|||||||
result = mavl_get_first(cache->byaddr, &search_ptr);
|
result = mavl_get_first(cache->byaddr, &search_ptr);
|
||||||
if (result == NULL)
|
if (result == NULL)
|
||||||
return 0;
|
return 0;
|
||||||
|
{
|
||||||
|
cw_dbg(DBG_X,"DISCOVERY CACHE ---------------------------- DOUND BY ADDR");
|
||||||
|
char str[128];
|
||||||
|
sock_addrtostr(addr,str,128,1);
|
||||||
|
printf("Add addr: %s\n",str);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
elem = *result;
|
elem = *result;
|
||||||
if (elem != NULL){
|
if (elem != NULL){
|
||||||
|
cw_dbg(DBG_X,"elem != NULL");
|
||||||
|
|
||||||
|
{
|
||||||
|
cw_dbg(DBG_X,"DISCOVERY CACHE ---------------------------- DOUND BY ADDR");
|
||||||
|
char str[128];
|
||||||
|
sock_addrtostr(&elem->addr,str,128,1);
|
||||||
|
printf("ELEM addr: %s\n",str);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
if (sock_cmpaddr((struct sockaddr*)&elem->addr,addr,0)!=0)
|
if (sock_cmpaddr((struct sockaddr*)&elem->addr,addr,0)!=0)
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
mavl_del(cache->byaddr,result);
|
cw_dbg(DBG_X,"DOIN MAVL DEL HERO ----- ///////////");
|
||||||
mavl_del(cache->byaddrp,result);
|
mavl_del(cache->byaddr,&elem);
|
||||||
|
cw_dbg(DBG_X,"DOIN MAVL DEL HERXXXXXXO ----- ///////////");
|
||||||
|
mavl_del(cache->byaddrp,&elem);
|
||||||
|
cw_dbg(DBG_X,"DOIN MAVL DEL HERO 0000 ----- ///////////");
|
||||||
|
|
||||||
*modcapwap=elem->cmod;
|
*modcapwap=elem->cmod;
|
||||||
*modbindings=elem->bmod;
|
*modbindings=elem->bmod;
|
||||||
|
@ -3,7 +3,7 @@
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
#include "cw/mod.h"
|
||||||
|
|
||||||
|
|
||||||
struct cw_DiscoveryCache * discovery_cache_create(int len);
|
struct cw_DiscoveryCache * discovery_cache_create(int len);
|
||||||
@ -14,4 +14,5 @@ void discovery_cache_add(struct cw_DiscoveryCache *cache,
|
|||||||
int discovery_cache_get(struct cw_DiscoveryCache * cache,struct sockaddr *addr,
|
int discovery_cache_get(struct cw_DiscoveryCache * cache,struct sockaddr *addr,
|
||||||
struct cw_Mod ** modcapwap, struct cw_Mod **modbindings);
|
struct cw_Mod ** modcapwap, struct cw_Mod **modbindings);
|
||||||
|
|
||||||
|
void discovery_cache_destroy(struct cw_DiscoveryCache * c);
|
||||||
#endif
|
#endif
|
@ -36,7 +36,7 @@ void wlan0_cmd(struct shelldata *sd, const char * cmd);
|
|||||||
void show_cfg (FILE *out, mavl_t ktv);
|
void show_cfg (FILE *out, mavl_t ktv);
|
||||||
void show_aps (FILE *out);
|
void show_aps (FILE *out);
|
||||||
|
|
||||||
struct conn * find_ap(const char *name);
|
struct cw_Conn * find_ap(const char *name);
|
||||||
|
|
||||||
struct command{
|
struct command{
|
||||||
char * cmd;
|
char * cmd;
|
||||||
@ -72,7 +72,7 @@ void list_cmd(struct shelldata *sd, const char *cmd)
|
|||||||
|
|
||||||
void cfg_cmd(struct shelldata *sd, const char *cmd)
|
void cfg_cmd(struct shelldata *sd, const char *cmd)
|
||||||
{
|
{
|
||||||
struct conn * conn;
|
struct cw_Conn * conn;
|
||||||
wtplist_lock();
|
wtplist_lock();
|
||||||
conn = find_ap(sd->prompt);
|
conn = find_ap(sd->prompt);
|
||||||
if (conn==NULL){
|
if (conn==NULL){
|
||||||
@ -86,7 +86,7 @@ void cfg_cmd(struct shelldata *sd, const char *cmd)
|
|||||||
|
|
||||||
void ucfg_cmd(struct shelldata *sd, const char *cmd)
|
void ucfg_cmd(struct shelldata *sd, const char *cmd)
|
||||||
{
|
{
|
||||||
struct conn * conn;
|
struct cw_Conn * conn;
|
||||||
show_cfg(sd->out,sd->update_cfg);
|
show_cfg(sd->out,sd->update_cfg);
|
||||||
|
|
||||||
}
|
}
|
||||||
@ -96,7 +96,7 @@ void ucfg_cmd(struct shelldata *sd, const char *cmd)
|
|||||||
void
|
void
|
||||||
send_cmd(struct shelldata * sd, const char *cmd)
|
send_cmd(struct shelldata * sd, const char *cmd)
|
||||||
{
|
{
|
||||||
struct conn * conn;
|
struct cw_Conn * conn;
|
||||||
wtplist_lock();
|
wtplist_lock();
|
||||||
conn = find_ap(sd->prompt);
|
conn = find_ap(sd->prompt);
|
||||||
if (conn==NULL){
|
if (conn==NULL){
|
||||||
@ -111,7 +111,9 @@ send_cmd(struct shelldata * sd, const char *cmd)
|
|||||||
void
|
void
|
||||||
wlan0_cmd(struct shelldata * sd, const char *cmd)
|
wlan0_cmd(struct shelldata * sd, const char *cmd)
|
||||||
{
|
{
|
||||||
struct conn * conn;
|
stop();
|
||||||
|
|
||||||
|
struct cw_Conn * conn;
|
||||||
wtplist_lock();
|
wtplist_lock();
|
||||||
conn = find_ap(sd->prompt);
|
conn = find_ap(sd->prompt);
|
||||||
if (conn==NULL){
|
if (conn==NULL){
|
||||||
@ -119,7 +121,7 @@ wlan0_cmd(struct shelldata * sd, const char *cmd)
|
|||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
FILE *f=fopen("wlan0.ktv","r");
|
FILE *f=fopen("wlan0.ktv","r");
|
||||||
cw_ktv_read_file(f,sd->update_cfg,conn->msgset->types_tree);
|
// cw_ktv_read_file(f,sd->update_cfg,conn->msgset->types_tree);
|
||||||
//conn->update_cfg=sd->update_cfg;
|
//conn->update_cfg=sd->update_cfg;
|
||||||
fclose(f);
|
fclose(f);
|
||||||
}
|
}
|
||||||
@ -129,12 +131,15 @@ wlan0_cmd(struct shelldata * sd, const char *cmd)
|
|||||||
|
|
||||||
void set_cmd(struct shelldata *sd, const char *str)
|
void set_cmd(struct shelldata *sd, const char *str)
|
||||||
{
|
{
|
||||||
struct conn * conn;
|
struct cw_Conn * conn;
|
||||||
struct cw_Val_Reader r;
|
struct cw_Val_Reader r;
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
char type[CW_KTV_MAX_KEY_LEN];
|
char type[CW_CFG_MAX_KEY_LEN];
|
||||||
char val[2048];
|
char val[2048];
|
||||||
cw_ktv_init_str_reader(&r,str,strlen(str));
|
|
||||||
|
stop();
|
||||||
|
|
||||||
|
// cw_ktv_init_str_reader(&r,str,strlen(str));
|
||||||
|
|
||||||
cw_ktv_parse_string(&r,key,type,val);
|
cw_ktv_parse_string(&r,key,type,val);
|
||||||
/*cw_ktv_parse_string(key,type,val, 2048);*/
|
/*cw_ktv_parse_string(key,type,val, 2048);*/
|
||||||
@ -145,9 +150,10 @@ void set_cmd(struct shelldata *sd, const char *str)
|
|||||||
|
|
||||||
void del_cmd(struct shelldata *sd, const char *str)
|
void del_cmd(struct shelldata *sd, const char *str)
|
||||||
{
|
{
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
sscanf(str,"%s",key);
|
sscanf(str,"%s",key);
|
||||||
cw_ktv_del_sub(sd->update_cfg,key);
|
stop();
|
||||||
|
// cw_ktv_del_sub(sd->update_cfg,key);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
@ -189,7 +195,7 @@ void show_aps (FILE *out)
|
|||||||
cw_Val_t * result;
|
cw_Val_t * result;
|
||||||
char addr[SOCK_ADDR_BUFSIZE];
|
char addr[SOCK_ADDR_BUFSIZE];
|
||||||
char wtp_name[CAPWAP_MAX_WTP_NAME_LEN];
|
char wtp_name[CAPWAP_MAX_WTP_NAME_LEN];
|
||||||
struct conn * conn;
|
struct cw_Conn * conn;
|
||||||
conn = mavliter_get_ptr (&it);
|
conn = mavliter_get_ptr (&it);
|
||||||
|
|
||||||
sock_addr2str_p (&conn->addr, addr);
|
sock_addr2str_p (&conn->addr, addr);
|
||||||
@ -211,7 +217,7 @@ void show_aps (FILE *out)
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
struct conn * find_ap(const char *name)
|
struct cw_Conn * find_ap(const char *name)
|
||||||
{
|
{
|
||||||
struct connlist * cl;
|
struct connlist * cl;
|
||||||
mavliter_t it;
|
mavliter_t it;
|
||||||
@ -224,7 +230,7 @@ struct conn * find_ap(const char *name)
|
|||||||
mavliter_foreach (&it) {
|
mavliter_foreach (&it) {
|
||||||
cw_Val_t * result;
|
cw_Val_t * result;
|
||||||
char wtp_name[CAPWAP_MAX_WTP_NAME_LEN];
|
char wtp_name[CAPWAP_MAX_WTP_NAME_LEN];
|
||||||
struct conn * conn;
|
struct cw_Conn * conn;
|
||||||
conn = mavliter_get_ptr (&it);
|
conn = mavliter_get_ptr (&it);
|
||||||
|
|
||||||
result = cw_ktv_get (conn->remote_cfg, "wtp-name", NULL);
|
result = cw_ktv_get (conn->remote_cfg, "wtp-name", NULL);
|
||||||
@ -266,7 +272,7 @@ void con (FILE *out)
|
|||||||
cw_Val_t * result;
|
cw_Val_t * result;
|
||||||
char addr[SOCK_ADDR_BUFSIZE];
|
char addr[SOCK_ADDR_BUFSIZE];
|
||||||
char wtp_name[CAPWAP_MAX_WTP_NAME_LEN];
|
char wtp_name[CAPWAP_MAX_WTP_NAME_LEN];
|
||||||
struct conn * conn;
|
struct cw_Conn * conn;
|
||||||
conn = mavliter_get_ptr (&it);
|
conn = mavliter_get_ptr (&it);
|
||||||
|
|
||||||
sock_addr2str_p (&conn->addr, addr);
|
sock_addr2str_p (&conn->addr, addr);
|
||||||
@ -342,7 +348,7 @@ void execute_cmd (struct shelldata * sd, const char *str)
|
|||||||
return;
|
return;
|
||||||
|
|
||||||
|
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
char type[128];
|
char type[128];
|
||||||
char val[2048];
|
char val[2048];
|
||||||
|
|
||||||
|
@ -335,7 +335,7 @@ static int socklist_check_size()
|
|||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
int socklist_add_unicast(const char *addr, const char *port, int ac_proto)
|
int socklist_add_unicast(const char *addr, const char *port, int ac_proto, int ipv4, int ipv6)
|
||||||
{
|
{
|
||||||
char sock_buf[SOCK_ADDR_BUFSIZE];
|
char sock_buf[SOCK_ADDR_BUFSIZE];
|
||||||
struct addrinfo hints;
|
struct addrinfo hints;
|
||||||
@ -365,6 +365,14 @@ int socklist_add_unicast(const char *addr, const char *port, int ac_proto)
|
|||||||
struct sockaddr *sa;
|
struct sockaddr *sa;
|
||||||
int sockfd;
|
int sockfd;
|
||||||
|
|
||||||
|
if (res->ai_addr->sa_family == AF_INET && !ipv4){
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
if (res->ai_addr->sa_family == AF_INET6 && !ipv6){
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
ifname[0] = 0;
|
ifname[0] = 0;
|
||||||
rc = sock_getifinfo(res->ai_addr, ifname, &broadcast, &netmask);
|
rc = sock_getifinfo(res->ai_addr, ifname, &broadcast, &netmask);
|
||||||
if (!rc) {
|
if (!rc) {
|
||||||
@ -372,6 +380,7 @@ int socklist_add_unicast(const char *addr, const char *port, int ac_proto)
|
|||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/* Bind the control port */
|
/* Bind the control port */
|
||||||
sa = res->ai_addr;
|
sa = res->ai_addr;
|
||||||
sockfd = socket(res->ai_addr->sa_family, SOCK_DGRAM, 0);
|
sockfd = socket(res->ai_addr->sa_family, SOCK_DGRAM, 0);
|
||||||
|
@ -40,7 +40,7 @@ struct socklistelem{
|
|||||||
|
|
||||||
|
|
||||||
extern int socklist_add_multicast(const char * addr, const char * port, int ac_proto);
|
extern int socklist_add_multicast(const char * addr, const char * port, int ac_proto);
|
||||||
extern int socklist_add_unicast(const char *addr, const char * port, int ac_proto);
|
extern int socklist_add_unicast(const char *addr, const char * port, int ac_proto, int ipv4, int ipv6);
|
||||||
extern int socklist_add_broadcast(const char *addr, const char * port,int ac_proto);
|
extern int socklist_add_broadcast(const char *addr, const char * port,int ac_proto);
|
||||||
extern int socklist_init();
|
extern int socklist_init();
|
||||||
extern void socklist_destroy();
|
extern void socklist_destroy();
|
||||||
|
137
src/ac/statemachine.c
Normal file
137
src/ac/statemachine.c
Normal file
@ -0,0 +1,137 @@
|
|||||||
|
#include <stdint.h>
|
||||||
|
|
||||||
|
#include <mavl.h>
|
||||||
|
|
||||||
|
#include "cw/capwap.h"
|
||||||
|
#include "cw/dbg.h"
|
||||||
|
|
||||||
|
#include "statemachine.h"
|
||||||
|
|
||||||
|
static cw_StateMachineState_t statemachine_states[];
|
||||||
|
|
||||||
|
int cw_statemachine_run(struct cw_StateMachine * mach)
|
||||||
|
{
|
||||||
|
struct mavl * st = cw_statemachine_load_states(NULL,statemachine_states);
|
||||||
|
mavl_destroy(st);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static cw_StateMachineState_t statemachine_states[]={
|
||||||
|
{ CW_STATE_NONE, CAPWAP_STATE_DISCOVERY, /* transition */
|
||||||
|
NULL,0 /* timer */
|
||||||
|
|
||||||
|
}
|
||||||
|
,
|
||||||
|
|
||||||
|
|
||||||
|
{
|
||||||
|
CAPWAP_STATE_DTLS_SETUP, CAPWAP_STATE_JOIN, /* transition */
|
||||||
|
"wait-join",CAPWAP_WAIT_JOIN, /* timer */
|
||||||
|
1 /* retval */
|
||||||
|
}
|
||||||
|
,
|
||||||
|
{
|
||||||
|
CAPWAP_STATE_JOIN,CAPWAP_STATE_TIMEOUT,
|
||||||
|
NULL,0,
|
||||||
|
0, "WTP Join timeout"
|
||||||
|
}
|
||||||
|
,
|
||||||
|
{
|
||||||
|
CAPWAP_STATE_JOIN, CAPWAP_STATE_JOIN,
|
||||||
|
NULL,0,
|
||||||
|
1, "WTP has joined"
|
||||||
|
|
||||||
|
}
|
||||||
|
,
|
||||||
|
{
|
||||||
|
CAPWAP_STATE_JOIN, CAPWAP_STATE_CONFIGURE,
|
||||||
|
"capwap-timers/change-state-pending-timer",CAPWAP_TIMER_CHANGE_STATE_PENDING_TIMER,
|
||||||
|
1, NULL
|
||||||
|
}
|
||||||
|
,
|
||||||
|
{
|
||||||
|
CAPWAP_STATE_CONFIGURE,CAPWAP_STATE_TIMEOUT,
|
||||||
|
NULL,0,
|
||||||
|
0, "WTP change state timeout"
|
||||||
|
}
|
||||||
|
,
|
||||||
|
{
|
||||||
|
CAPWAP_STATE_CONFIGURE,CAPWAP_STATE_DATA_CHECK,
|
||||||
|
"capwap-timers/data-check-timer",CAPWAP_TIMER_DATA_CHECK_TIMER,
|
||||||
|
1, NULL
|
||||||
|
}
|
||||||
|
,
|
||||||
|
{
|
||||||
|
CAPWAP_STATE_DATA_CHECK,CAPWAP_STATE_TIMEOUT,
|
||||||
|
NULL,0,
|
||||||
|
0, "WTP data check timeout"
|
||||||
|
}
|
||||||
|
,
|
||||||
|
|
||||||
|
{
|
||||||
|
CAPWAP_STATE_DATA_CHECK,CAPWAP_STATE_RUN,
|
||||||
|
"capwap-timers/echo-interval",CAPWAP_ECHO_INTERVAL,
|
||||||
|
1, NULL
|
||||||
|
}
|
||||||
|
,
|
||||||
|
{
|
||||||
|
CAPWAP_STATE_RUN,CAPWAP_STATE_RUN,
|
||||||
|
"capwap-timers/echo-interval",CAPWAP_ECHO_INTERVAL,
|
||||||
|
1, NULL
|
||||||
|
}
|
||||||
|
,
|
||||||
|
{
|
||||||
|
CAPWAP_STATE_RUN,CAPWAP_STATE_TIMEOUT,
|
||||||
|
NULL,0,
|
||||||
|
0, "WTP echo timout"
|
||||||
|
}
|
||||||
|
,
|
||||||
|
{0,0,0}
|
||||||
|
};
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
static int cmp_statemachine_state(const void *state1, const void *state2)
|
||||||
|
{
|
||||||
|
const struct cw_StateMachineState *s1 = state1;
|
||||||
|
const struct cw_StateMachineState *s2 = state2;
|
||||||
|
int rc;
|
||||||
|
rc = s1->state - s2->state;
|
||||||
|
if (rc!=0)
|
||||||
|
return rc;
|
||||||
|
return s1->prevstate-s2->prevstate;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
struct mavl * cw_statemachine_load_states (struct mavl * statemachine_states, cw_StateMachineState_t * states)
|
||||||
|
{
|
||||||
|
cw_StateMachineState_t * s;
|
||||||
|
int replaced;
|
||||||
|
cw_dbg(DBG_STATE,"Loading State Machine States");
|
||||||
|
|
||||||
|
if (statemachine_states == NULL){
|
||||||
|
statemachine_states = mavl_create(cmp_statemachine_state,NULL,sizeof(cw_StateMachineState_t));
|
||||||
|
if (statemachine_states == NULL)
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
s=states;
|
||||||
|
while (s->state != 0){
|
||||||
|
const char * repstr;
|
||||||
|
mavl_replace(statemachine_states,s,&replaced);
|
||||||
|
|
||||||
|
if (replaced){
|
||||||
|
repstr = "Replacing";
|
||||||
|
}
|
||||||
|
else{
|
||||||
|
repstr = "Adding";
|
||||||
|
}
|
||||||
|
cw_dbg(DBG_STATE," %s: [%s->%s]",repstr,
|
||||||
|
cw_strstate(s->prevstate),
|
||||||
|
cw_strstate(s->state));
|
||||||
|
s++;
|
||||||
|
}
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
13
src/ac/statemachine.h
Normal file
13
src/ac/statemachine.h
Normal file
@ -0,0 +1,13 @@
|
|||||||
|
#ifndef STATEMACHINE_H
|
||||||
|
#define STATEMACHINE_H
|
||||||
|
|
||||||
|
struct cw_StateMachine{
|
||||||
|
uint8_t prevstate,currentstate;
|
||||||
|
|
||||||
|
};
|
||||||
|
|
||||||
|
|
||||||
|
struct mavl * cw_statemachine_load_states (struct mavl * statemachine_states, cw_StateMachineState_t * states);
|
||||||
|
int cw_statemachine_run(struct cw_StateMachine * mach);
|
||||||
|
|
||||||
|
#endif
|
@ -71,7 +71,7 @@ void wtplist_destroy()
|
|||||||
struct wtpman * wtplist_get(const struct sockaddr * addr)
|
struct wtpman * wtplist_get(const struct sockaddr * addr)
|
||||||
{
|
{
|
||||||
|
|
||||||
struct conn * conn = connlist_get(connlist,addr);
|
struct cw_Conn * conn = connlist_get(connlist,addr);
|
||||||
if (!conn)
|
if (!conn)
|
||||||
return 0;
|
return 0;
|
||||||
return conn->data;
|
return conn->data;
|
||||||
@ -80,8 +80,8 @@ struct wtpman * wtplist_get(const struct sockaddr * addr)
|
|||||||
|
|
||||||
struct wtpman * wtplist_get_by_session_id(bstr16_t *session_id)
|
struct wtpman * wtplist_get_by_session_id(bstr16_t *session_id)
|
||||||
{
|
{
|
||||||
struct conn search;
|
struct cw_Conn search;
|
||||||
struct conn * conn;
|
struct cw_Conn * conn;
|
||||||
|
|
||||||
search.session_id = session_id;
|
search.session_id = session_id;
|
||||||
/*memcpy (search.session_id, session_id,16);*/
|
/*memcpy (search.session_id, session_id,16);*/
|
||||||
|
413
src/ac/wtpman.c
413
src/ac/wtpman.c
@ -37,7 +37,6 @@
|
|||||||
|
|
||||||
#include "ac.h"
|
#include "ac.h"
|
||||||
#include "conf.h"
|
#include "conf.h"
|
||||||
#include "db.h"
|
|
||||||
#include "socklist.h"
|
#include "socklist.h"
|
||||||
#include "wtpman.h"
|
#include "wtpman.h"
|
||||||
#include "wtplist.h"
|
#include "wtplist.h"
|
||||||
@ -45,34 +44,6 @@
|
|||||||
|
|
||||||
#include "actube.h"
|
#include "actube.h"
|
||||||
|
|
||||||
static void reset_echointerval_timer(struct wtpman *wtpman)
|
|
||||||
{
|
|
||||||
/* char sock_buf[SOCK_ADDR_BUFSIZE];*/
|
|
||||||
/* uint16_t ct = mbag_get_word(wtpman->conn->local, CW_ITEM_CAPWAP_TIMERS,
|
|
||||||
CW_MAX_DISCOVERY_INTERVAL << 8 |
|
|
||||||
CAPWAP_ECHO_INTERVAL);
|
|
||||||
*/
|
|
||||||
/* start echinterval timer and put 2 seconds for "safety" on it */
|
|
||||||
|
|
||||||
/*
|
|
||||||
// wtpman->echointerval_timer = cw_timer_start(2+ (ct & 0xff));
|
|
||||||
// db_ping_wtp(sock_addr2str_p(&wtpman->conn->addr,sock_buf), conf_acname);
|
|
||||||
// cw_dbg(DBG_X, "Starting capwap timer: %d", wtpman->echointerval_timer);
|
|
||||||
*/
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
static int msg_start_handler(struct conn *conn, struct cw_action_in *a, uint8_t * data,
|
|
||||||
int len, struct sockaddr *from)
|
|
||||||
{
|
|
||||||
struct wtpman *wtpman = conn->data;
|
|
||||||
reset_echointerval_timer(wtpman);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
static void wtpman_remove(struct wtpman *wtpman)
|
static void wtpman_remove(struct wtpman *wtpman)
|
||||||
{
|
{
|
||||||
@ -86,26 +57,30 @@ static void wtpman_remove(struct wtpman *wtpman)
|
|||||||
|
|
||||||
static void wtpman_run_discovery(void *arg)
|
static void wtpman_run_discovery(void *arg)
|
||||||
{
|
{
|
||||||
|
|
||||||
struct wtpman *wtpman = (struct wtpman *) arg;
|
struct wtpman *wtpman = (struct wtpman *) arg;
|
||||||
|
|
||||||
time_t timer = cw_timer_start(10);
|
time_t timer = cw_timer_start(10);
|
||||||
|
|
||||||
wtpman->conn->capwap_state = CAPWAP_STATE_DISCOVERY;
|
wtpman->conn->capwap_state = CAPWAP_STATE_DISCOVERY;
|
||||||
|
|
||||||
|
|
||||||
while (!cw_timer_timeout(timer)
|
while (!cw_timer_timeout(timer)
|
||||||
&& wtpman->conn->capwap_state == CAPWAP_STATE_DISCOVERY) {
|
&& wtpman->conn->capwap_state == CAPWAP_STATE_DISCOVERY) {
|
||||||
int rc;
|
int rc;
|
||||||
rc = cw_read_messages(wtpman->conn);
|
rc = cw_read_messages(wtpman->conn);
|
||||||
if (cw_result_is_ok(rc)){
|
|
||||||
wtpman->conn->capwap_state=CAPWAP_STATE_JOIN;
|
|
||||||
|
|
||||||
cw_dbg(DBG_INFO,"Discovery has detected mods: %s %s",
|
if (cw_result_is_ok(rc)) {
|
||||||
wtpman->conn->cmod->name,wtpman->conn->bmod->name);
|
wtpman->conn->capwap_state = CAPWAP_STATE_JOIN;
|
||||||
|
|
||||||
|
cw_dbg(DBG_INFO, "Discovery has detected mods: %s %s",
|
||||||
|
wtpman->conn->cmod->name,
|
||||||
|
wtpman->conn->bmod->name);
|
||||||
|
|
||||||
wtplist_lock();
|
wtplist_lock();
|
||||||
discovery_cache_add(discovery_cache,(struct sockaddr*)&wtpman->conn->addr,
|
discovery_cache_add(discovery_cache,
|
||||||
wtpman->conn->cmod,wtpman->conn->bmod);
|
(struct sockaddr *) &wtpman->conn->
|
||||||
|
addr, wtpman->conn->cmod,
|
||||||
|
wtpman->conn->bmod);
|
||||||
wtplist_unlock();
|
wtplist_unlock();
|
||||||
|
|
||||||
}
|
}
|
||||||
@ -124,33 +99,37 @@ static int wtpman_dtls_setup(void *arg)
|
|||||||
/* try to accept the connection */
|
/* try to accept the connection */
|
||||||
if (!dtls_accept(wtpman->conn)) {
|
if (!dtls_accept(wtpman->conn)) {
|
||||||
cw_dbg(DBG_DTLS, "Error establishing DTLS session with %s",
|
cw_dbg(DBG_DTLS, "Error establishing DTLS session with %s",
|
||||||
sock_addr2str_p(&wtpman->conn->addr,sock_buf));
|
sock_addr2str_p(&wtpman->conn->addr, sock_buf));
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
cw_dbg(DBG_DTLS, "DTLS session established with %s, %s",
|
cw_dbg(DBG_DTLS, "DTLS session established with %s, %s",
|
||||||
sock_addr2str_p(&wtpman->conn->addr,sock_buf), dtls_get_cipher(wtpman->conn,cipherstr));
|
sock_addr2str_p(&wtpman->conn->addr, sock_buf),
|
||||||
|
dtls_get_cipher(wtpman->conn, cipherstr));
|
||||||
|
|
||||||
|
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
/*
|
||||||
static int wtpman_join(void *arg)
|
static int wtpman_join(void *arg)
|
||||||
{
|
{
|
||||||
int rc;
|
int rc;
|
||||||
char sock_buf[SOCK_ADDR_BUFSIZE];
|
char sock_buf[SOCK_ADDR_BUFSIZE];
|
||||||
struct wtpman *wtpman = (struct wtpman *) arg;
|
struct wtpman *wtpman = (struct wtpman *) arg;
|
||||||
struct conn *conn = wtpman->conn;
|
struct cw_Conn *conn = wtpman->conn;
|
||||||
time_t timer, wait_join;
|
time_t timer, wait_join;
|
||||||
|
|
||||||
cw_dbg(DBG_INFO, "Join State - %s", sock_addr2str(&conn->addr,sock_buf));
|
cw_dbg(DBG_INFO, "Join State - %s",
|
||||||
|
sock_addr2str(&conn->addr, sock_buf));
|
||||||
|
|
||||||
wait_join = cw_ktv_get_word(conn->global_cfg,"wait-join",CAPWAP_WAIT_JOIN);
|
wait_join =
|
||||||
|
cw_ktv_get_word(conn->global_cfg, "wait-join", CAPWAP_WAIT_JOIN);
|
||||||
|
|
||||||
timer = cw_timer_start(wait_join);
|
timer = cw_timer_start(wait_join);
|
||||||
|
|
||||||
|
|
||||||
while (!cw_timer_timeout(timer) && wtpman->conn->capwap_state == CAPWAP_STATE_JOIN) {
|
while (!cw_timer_timeout(timer)
|
||||||
|
&& wtpman->conn->capwap_state == CAPWAP_STATE_JOIN) {
|
||||||
rc = cw_read_messages(wtpman->conn);
|
rc = cw_read_messages(wtpman->conn);
|
||||||
if (rc < 0) {
|
if (rc < 0) {
|
||||||
if (errno == EAGAIN)
|
if (errno == EAGAIN)
|
||||||
@ -158,9 +137,9 @@ static int wtpman_join(void *arg)
|
|||||||
|
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
cw_dbg_ktv_dump(conn->remote_cfg,DBG_INFO,
|
cw_dbg_ktv_dump(conn->remote_cfg, DBG_INFO,
|
||||||
"-------------dump------------",
|
"-------------dump------------",
|
||||||
"DMP","---------end dump --------");
|
"DMP", "---------end dump --------");
|
||||||
}
|
}
|
||||||
|
|
||||||
if (rc != 0) {
|
if (rc != 0) {
|
||||||
@ -170,8 +149,9 @@ static int wtpman_join(void *arg)
|
|||||||
|
|
||||||
|
|
||||||
if (wtpman->conn->capwap_state != CAPWAP_STATE_JOIN_COMPLETE) {
|
if (wtpman->conn->capwap_state != CAPWAP_STATE_JOIN_COMPLETE) {
|
||||||
cw_dbg(DBG_MSG_ERR, "No join request from %s after %d seconds, WTP died.",
|
cw_dbg(DBG_MSG_ERR,
|
||||||
sock_addr2str(&wtpman->conn->addr,sock_buf), wait_join);
|
"No join request from %s after %d seconds, WTP died.",
|
||||||
|
sock_addr2str(&wtpman->conn->addr, sock_buf), wait_join);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
@ -181,11 +161,14 @@ static int wtpman_join(void *arg)
|
|||||||
|
|
||||||
|
|
||||||
}
|
}
|
||||||
|
*/
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
static void wtpman_image_data(struct wtpman *wtpman)
|
static void wtpman_image_data(struct wtpman *wtpman)
|
||||||
{
|
{
|
||||||
/* char sock_buf[SOCK_ADDR_BUFSIZE];
|
/* char sock_buf[SOCK_ADDR_BUFSIZE];
|
||||||
struct conn *conn = wtpman->conn;
|
struct cw_Conn *conn = wtpman->conn;
|
||||||
|
|
||||||
// Image upload
|
// Image upload
|
||||||
const char *filename = mbag_get_str(conn->outgoing, CW_ITEM_IMAGE_FILENAME, NULL);
|
const char *filename = mbag_get_str(conn->outgoing, CW_ITEM_IMAGE_FILENAME, NULL);
|
||||||
@ -241,13 +224,13 @@ static void wtpman_image_data(struct wtpman *wtpman)
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
void * wtpman_run_data(void *wtpman_arg)
|
void *wtpman_run_data(void *wtpman_arg)
|
||||||
{
|
{
|
||||||
|
|
||||||
return NULL;
|
return NULL;
|
||||||
/*
|
/*
|
||||||
struct wtpman *wtpman = (struct wtpman *) wtpman_arg;
|
struct wtpman *wtpman = (struct wtpman *) wtpman_arg;
|
||||||
struct conn *conn = wtpman->conn;
|
struct cw_Conn *conn = wtpman->conn;
|
||||||
|
|
||||||
|
|
||||||
uint8_t data[1001];
|
uint8_t data[1001];
|
||||||
@ -263,44 +246,49 @@ void * wtpman_run_data(void *wtpman_arg)
|
|||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
int cw_run_state_machine(struct conn * conn, time_t *timer)
|
|
||||||
|
|
||||||
|
int cw_run_state_machine(struct cw_Conn *conn, time_t * timer)
|
||||||
{
|
{
|
||||||
|
|
||||||
int timerval;
|
int timerval;
|
||||||
cw_StateMachineState_t search, *result;
|
cw_StateMachineState_t search, *result;
|
||||||
|
|
||||||
|
|
||||||
while(1){
|
while (1) {
|
||||||
search.state = conn->capwap_state;
|
search.state = conn->capwap_state;
|
||||||
search.prevstate = conn->capwap_prevstate;
|
search.prevstate = conn->capwap_prevstate;
|
||||||
result = mavl_get(conn->msgset->state_machine,&search);
|
result = mavl_get(conn->msgset->statemachine_states, &search);
|
||||||
|
|
||||||
cw_dbg(DBG_STATE,"State transition: [%s -> %s]",
|
cw_dbg(DBG_STATE, "State transition: [%s -> %s]",
|
||||||
cw_strstate(conn->capwap_prevstate),
|
cw_strstate(conn->capwap_prevstate),
|
||||||
cw_strstate(conn->capwap_state)
|
cw_strstate(conn->capwap_state)
|
||||||
);
|
);
|
||||||
if (result == NULL){
|
if (result == NULL) {
|
||||||
cw_log(LOG_ERR,"State not found");
|
cw_log(LOG_ERR, "State not found");
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
if (result->jump_state){
|
if (result->jump_state) {
|
||||||
conn->capwap_state = result->jump_state;
|
conn->capwap_state = result->jump_state;
|
||||||
conn->capwap_prevstate = result->jump_prevstate;
|
conn->capwap_prevstate = result->jump_prevstate;
|
||||||
|
|
||||||
cw_dbg(DBG_STATE,"Jump to state: [%s->%s]",
|
cw_dbg(DBG_STATE, "Jump to state: [%s->%s]",
|
||||||
cw_strstate(conn->capwap_prevstate),
|
cw_strstate(conn->capwap_prevstate),
|
||||||
cw_strstate(conn->capwap_state));
|
cw_strstate(conn->capwap_state));
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (result->dbgmsg){
|
if (result->dbgmsg) {
|
||||||
cw_dbg(DBG_STATE,"%s",result->dbgmsg);
|
cw_dbg(DBG_STATE, "%s", result->dbgmsg);
|
||||||
}
|
}
|
||||||
|
|
||||||
if (result->timer_key){
|
if (result->timer_key) {
|
||||||
timerval = cw_ktv_get_word(conn->local_cfg,result->timer_key,result->timer_default);
|
timerval =
|
||||||
|
cw_cfg_get_word(conn->local_cfg, result->timer_key,
|
||||||
|
result->timer_default);
|
||||||
*timer = cw_timer_start(timerval);
|
*timer = cw_timer_start(timerval);
|
||||||
cw_dbg(DBG_STATE,"Starting timer: [%s] - %d seconds.",result->timer_key,timerval);
|
cw_dbg(DBG_STATE, "Starting timer: [%s] - %d seconds.",
|
||||||
|
result->timer_key, timerval);
|
||||||
}
|
}
|
||||||
return result->retval;
|
return result->retval;
|
||||||
}
|
}
|
||||||
@ -309,26 +297,25 @@ int cw_run_state_machine(struct conn * conn, time_t *timer)
|
|||||||
|
|
||||||
/*#define CW_TRANSITION(prestate,state) (prestate<<16|state)*/
|
/*#define CW_TRANSITION(prestate,state) (prestate<<16|state)*/
|
||||||
|
|
||||||
static void * wtpman_main(void *arg)
|
static void *wtpman_main(void *arg)
|
||||||
{
|
{
|
||||||
mavl_t r;
|
mavl_t r;
|
||||||
int rc ;
|
int rc;
|
||||||
time_t timer;
|
time_t timer;
|
||||||
char sock_buf[SOCK_ADDR_BUFSIZE];
|
char sock_buf[SOCK_ADDR_BUFSIZE];
|
||||||
struct conn *conn;
|
struct cw_Conn *conn;
|
||||||
int last_state;
|
int last_state;
|
||||||
|
|
||||||
struct wtpman *wtpman = (struct wtpman *) arg;
|
struct wtpman *wtpman = (struct wtpman *) arg;
|
||||||
|
|
||||||
wtpman->conn->seqnum = 0;
|
wtpman->conn->seqnum = 0;
|
||||||
conn = wtpman->conn;
|
conn = wtpman->conn;
|
||||||
|
|
||||||
wtpman->conn->remote_cfg = cw_ktv_create();
|
// wtpman->conn->remote_cfg = cw_cfg_create();
|
||||||
|
|
||||||
|
|
||||||
/* We were invoked with an unencrypted packet,
|
if (!wtpman->dtlsmode) {
|
||||||
* so assume, it is a discovery request */
|
/* We were invoked with an unencrypted packet,
|
||||||
if (!wtpman->dtlsmode){
|
* so assume, it is a discovery request */
|
||||||
wtpman_run_discovery(arg);
|
wtpman_run_discovery(arg);
|
||||||
wtpman_remove(wtpman);
|
wtpman_remove(wtpman);
|
||||||
return NULL;
|
return NULL;
|
||||||
@ -337,7 +324,7 @@ static void * wtpman_main(void *arg)
|
|||||||
|
|
||||||
/* reject connections to our multi- or broadcast sockets */
|
/* reject connections to our multi- or broadcast sockets */
|
||||||
if (socklist[wtpman->socklistindex].type != SOCKLIST_UNICAST_SOCKET) {
|
if (socklist[wtpman->socklistindex].type != SOCKLIST_UNICAST_SOCKET) {
|
||||||
cw_dbg(DBG_DTLS,"Reject multi");
|
cw_dbg(DBG_DTLS, "Reject multi");
|
||||||
wtpman_remove(wtpman);
|
wtpman_remove(wtpman);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
@ -350,51 +337,27 @@ static void * wtpman_main(void *arg)
|
|||||||
}
|
}
|
||||||
|
|
||||||
/*last_state = conn->capwap_state;
|
/*last_state = conn->capwap_state;
|
||||||
conn->capwap_state = CAPWAP_STATE_JOIN;
|
conn->capwap_state = CAPWAP_STATE_JOIN;
|
||||||
*/
|
*/
|
||||||
conn->capwap_prevstate = CAPWAP_STATE_DTLS_SETUP;
|
conn->capwap_prevstate = CAPWAP_STATE_DTLS_SETUP;
|
||||||
conn->capwap_state = CAPWAP_STATE_JOIN;
|
conn->capwap_state = CAPWAP_STATE_JOIN;
|
||||||
rc = 0;
|
rc = 0;
|
||||||
|
|
||||||
while (1){
|
while (1) {
|
||||||
|
|
||||||
int wait_join;
|
int wait_join;
|
||||||
int wait_change_state;
|
int wait_change_state;
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
if (!cw_run_state_machine(conn, &timer)){
|
if (!cw_run_state_machine(conn, &timer)) {
|
||||||
cw_dbg(DBG_INFO,"WTP died");
|
cw_dbg(DBG_INFO, "WTP died");
|
||||||
wtpman_remove(wtpman);
|
wtpman_remove(wtpman);
|
||||||
return NULL;
|
return NULL;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
while (!cw_timer_timeout(timer)) {
|
while (!cw_timer_timeout(timer)) {
|
||||||
if (conn->update_cfg != NULL){
|
|
||||||
mavl_t tmp;
|
|
||||||
|
|
||||||
|
|
||||||
tmp = conn->local_cfg;
|
|
||||||
|
|
||||||
mavl_merge(conn->default_cfg, conn->local_cfg);
|
|
||||||
/* mavl_merge(conn->default_cfg, conn->remote_cfg);*/
|
|
||||||
|
|
||||||
conn->local_cfg=conn->update_cfg;
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
cw_dbg(DBG_INFO, "Updating WTP %s",sock_addr2str(&conn->addr,sock_buf));
|
|
||||||
|
|
||||||
rc = cw_send_request(conn, CAPWAP_MSG_CONFIGURATION_UPDATE_REQUEST);
|
|
||||||
mavl_merge(conn->remote_cfg,conn->update_cfg);
|
|
||||||
|
|
||||||
conn->update_cfg=NULL;
|
|
||||||
conn->local_cfg=tmp;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
rc = cw_read_messages(wtpman->conn);
|
rc = cw_read_messages(wtpman->conn);
|
||||||
if (rc < 0) {
|
if (rc < 0) {
|
||||||
@ -404,7 +367,7 @@ static void * wtpman_main(void *arg)
|
|||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
if(rc<0){
|
if (rc < 0) {
|
||||||
conn->capwap_prevstate = conn->capwap_state;
|
conn->capwap_prevstate = conn->capwap_state;
|
||||||
conn->capwap_state = CAPWAP_STATE_TIMEOUT;
|
conn->capwap_state = CAPWAP_STATE_TIMEOUT;
|
||||||
}
|
}
|
||||||
@ -443,11 +406,11 @@ static void * wtpman_main(void *arg)
|
|||||||
|
|
||||||
|
|
||||||
cw_dbg(DBG_INFO, "WTP from %s has joined with session id: %s",
|
cw_dbg(DBG_INFO, "WTP from %s has joined with session id: %s",
|
||||||
sock_addr2str_p(&conn->addr,sock_buf),
|
sock_addr2str_p(&conn->addr, sock_buf),
|
||||||
format_bin2hex(conn->session_id,16));
|
format_bin2hex(conn->session_id, 16));
|
||||||
|
|
||||||
|
|
||||||
exit(0);
|
exit(0);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
// cw_dbg(DBG_INFO, "Creating data thread");
|
// cw_dbg(DBG_INFO, "Creating data thread");
|
||||||
@ -469,7 +432,9 @@ exit(0);
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
cw_dbg_ktv_dump(conn->remote_cfg,DBG_INFO,"-------------dump------------","DMP","---------end dump --------");
|
cw_dbg_ktv_dump(conn->remote_cfg, DBG_INFO,
|
||||||
|
"-------------dump------------", "DMP",
|
||||||
|
"---------end dump --------");
|
||||||
|
|
||||||
if (!cw_result_is_ok(rc)) {
|
if (!cw_result_is_ok(rc)) {
|
||||||
cw_dbg(DBG_INFO, "WTP Problem: %s", cw_strrc(rc));
|
cw_dbg(DBG_INFO, "WTP Problem: %s", cw_strrc(rc));
|
||||||
@ -494,7 +459,7 @@ cw_dbg_ktv_dump(conn->remote_cfg,DBG_INFO,"-------------dump------------","DMP",
|
|||||||
// radios_to_sql(conn);
|
// radios_to_sql(conn);
|
||||||
*/
|
*/
|
||||||
|
|
||||||
/*conn->msg_end=msg_end_handler;*/
|
/*conn->msg_end=msg_end_handler; */
|
||||||
/* The main run loop */
|
/* The main run loop */
|
||||||
reset_echointerval_timer(wtpman);
|
reset_echointerval_timer(wtpman);
|
||||||
|
|
||||||
@ -508,12 +473,12 @@ cw_dbg_ktv_dump(conn->remote_cfg,DBG_INFO,"-------------dump------------","DMP",
|
|||||||
|
|
||||||
/*// cw_dbg(DBG_X, "Time left: %d",
|
/*// cw_dbg(DBG_X, "Time left: %d",
|
||||||
// */
|
// */
|
||||||
/*cw_timer_timeleft(wtpman->echointerval_timer);*/
|
/*cw_timer_timeleft(wtpman->echointerval_timer); */
|
||||||
|
|
||||||
if (cw_timer_timeout(wtpman->echointerval_timer)) {
|
if (cw_timer_timeout(wtpman->echointerval_timer)) {
|
||||||
|
|
||||||
cw_dbg(DBG_INFO, "Lost connection to WTP:%s",
|
cw_dbg(DBG_INFO, "Lost connection to WTP:%s",
|
||||||
sock_addr2str_p(&conn->addr,sock_buf));
|
sock_addr2str_p(&conn->addr, sock_buf));
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
/*
|
/*
|
||||||
@ -526,16 +491,19 @@ cw_dbg_ktv_dump(conn->remote_cfg,DBG_INFO,"-------------dump------------","DMP",
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
r = db_get_update_tasks(conn, sock_addr2str(&conn->addr,sock_buf));
|
r = db_get_update_tasks(conn,
|
||||||
|
sock_addr2str(&conn->addr, sock_buf));
|
||||||
if (r) {
|
if (r) {
|
||||||
|
|
||||||
/*
|
/*
|
||||||
// if (!conn->outgoing->count)
|
// if (!conn->outgoing->count)
|
||||||
// continue;
|
// continue;
|
||||||
*/
|
*/
|
||||||
cw_dbg(DBG_INFO, "Updating WTP %s",sock_addr2str(&conn->addr,sock_buf));
|
cw_dbg(DBG_INFO, "Updating WTP %s",
|
||||||
|
sock_addr2str(&conn->addr, sock_buf));
|
||||||
|
|
||||||
rc = cw_send_request(conn, CAPWAP_MSG_CONFIGURATION_UPDATE_REQUEST);
|
rc = cw_send_request(conn,
|
||||||
|
CAPWAP_MSG_CONFIGURATION_UPDATE_REQUEST);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
// mavl_merge(conn->config, conn->outgoing);
|
// mavl_merge(conn->config, conn->outgoing);
|
||||||
@ -547,15 +515,18 @@ cw_dbg_ktv_dump(conn->remote_cfg,DBG_INFO,"-------------dump------------","DMP",
|
|||||||
*/
|
*/
|
||||||
}
|
}
|
||||||
|
|
||||||
r = db_get_radio_tasks(conn, sock_addr2str(&conn->addr,sock_buf));
|
r = db_get_radio_tasks(conn,
|
||||||
|
sock_addr2str(&conn->addr, sock_buf));
|
||||||
if (r) {
|
if (r) {
|
||||||
|
|
||||||
/*
|
/*
|
||||||
// if (!conn->radios_upd->count)
|
// if (!conn->radios_upd->count)
|
||||||
// continue;
|
// continue;
|
||||||
*/
|
*/
|
||||||
cw_dbg(DBG_INFO, "Updating Radios for %s",sock_addr2str(&conn->addr,sock_buf));
|
cw_dbg(DBG_INFO, "Updating Radios for %s",
|
||||||
rc = cw_send_request(conn, CAPWAP_MSG_CONFIGURATION_UPDATE_REQUEST);
|
sock_addr2str(&conn->addr, sock_buf));
|
||||||
|
rc = cw_send_request(conn,
|
||||||
|
CAPWAP_MSG_CONFIGURATION_UPDATE_REQUEST);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
// conn_clear_upd(conn,1);
|
// conn_clear_upd(conn,1);
|
||||||
@ -567,21 +538,21 @@ cw_dbg_ktv_dump(conn->remote_cfg,DBG_INFO,"-------------dump------------","DMP",
|
|||||||
// radios_to_sql(conn);
|
// radios_to_sql(conn);
|
||||||
*/
|
*/
|
||||||
/*
|
/*
|
||||||
rc = cw_send_request(conn, CW_MSG_CONFIGURATION_UPDATE_REQUEST);
|
rc = cw_send_request(conn, CW_MSG_CONFIGURATION_UPDATE_REQUEST);
|
||||||
mavl_merge(conn->config, conn->outgoing);
|
mavl_merge(conn->config, conn->outgoing);
|
||||||
mavl_destroy(conn->outgoing);
|
mavl_destroy(conn->outgoing);
|
||||||
conn->outgoing = mbag_create();
|
conn->outgoing = mbag_create();
|
||||||
config_to_sql(conn);
|
config_to_sql(conn);
|
||||||
radios_to_sql(conn);
|
radios_to_sql(conn);
|
||||||
mavl_destroy(r);
|
mavl_destroy(r);
|
||||||
*/
|
*/
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
db_ping_wtp(sock_addr2str_p(&conn->addr,sock_buf), "");
|
db_ping_wtp(sock_addr2str_p(&conn->addr, sock_buf), "");
|
||||||
wtpman_remove(wtpman);
|
wtpman_remove(wtpman);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
@ -596,8 +567,9 @@ static void wtpman_run_dtls(void *arg)
|
|||||||
|
|
||||||
/* reject connections to our multi- or broadcast sockets */
|
/* reject connections to our multi- or broadcast sockets */
|
||||||
if (socklist[wtpman->socklistindex].type != SOCKLIST_UNICAST_SOCKET) {
|
if (socklist[wtpman->socklistindex].type != SOCKLIST_UNICAST_SOCKET) {
|
||||||
cw_dbg(DBG_DTLS, "Dropping connection from %s to non-unicast socket.",
|
cw_dbg(DBG_DTLS,
|
||||||
sock_addr2str_p(&wtpman->conn->addr,sock_buf));
|
"Dropping connection from %s to non-unicast socket.",
|
||||||
|
sock_addr2str_p(&wtpman->conn->addr, sock_buf));
|
||||||
wtpman_remove(wtpman);
|
wtpman_remove(wtpman);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
@ -618,12 +590,85 @@ void wtpman_destroy(struct wtpman *wtpman)
|
|||||||
{
|
{
|
||||||
if (wtpman->conn)
|
if (wtpman->conn)
|
||||||
conn_destroy(wtpman->conn);
|
conn_destroy(wtpman->conn);
|
||||||
|
|
||||||
|
if (wtpman->wtp_cfg)
|
||||||
|
cw_cfg_destroy(wtpman->wtp_cfg);
|
||||||
|
|
||||||
free(wtpman);
|
free(wtpman);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static void copy(struct cw_ElemHandlerParams * params)
|
||||||
|
{
|
||||||
|
struct wtpman * wtpman;
|
||||||
|
struct cw_Conn * conn;
|
||||||
|
wtpman = (struct wtpman*)params->conn->data;
|
||||||
|
conn = (struct cw_Conn*)params->conn;
|
||||||
|
|
||||||
struct wtpman *wtpman_create(int socklistindex, struct sockaddr *srcaddr, int dtlsmode)
|
|
||||||
|
cw_dbg(DBG_X,"------------- Here is the config we ve got from WTP ---------------- ");
|
||||||
|
cw_cfg_dump(params->cfg);
|
||||||
|
cw_dbg(DBG_X,"------------- This was the config we ve got from WTP ---------------- ");
|
||||||
|
cw_dbg(DBG_X,"Now copying:");
|
||||||
|
cw_cfg_copy(params->cfg,conn->local_cfg);
|
||||||
|
cw_dbg(DBG_X,"Copying done.");
|
||||||
|
}
|
||||||
|
|
||||||
|
static int discovery_cb(struct cw_ElemHandlerParams * params, uint8_t * elems_ptr, int elems_len)
|
||||||
|
{
|
||||||
|
cw_dbg(DBG_X,"DISCOVERY Callback");
|
||||||
|
copy(params);
|
||||||
|
cw_cfg_clear(params->cfg);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int join_cb(struct cw_ElemHandlerParams * params, uint8_t * elems_ptr, int elems_len)
|
||||||
|
{
|
||||||
|
struct cw_Conn * conn = (struct cw_Conn*)params->conn;
|
||||||
|
char filename[200];
|
||||||
|
|
||||||
|
cw_dbg(DBG_X,"JOIN Callback");
|
||||||
|
copy(params);
|
||||||
|
const char * wtpname = cw_cfg_get(conn->local_cfg,"wtp-name","default");
|
||||||
|
sprintf(filename,"wtp-join-%s.ckv",wtpname);
|
||||||
|
cw_cfg_save(filename,params->cfg);
|
||||||
|
cw_cfg_clear(params->cfg);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int update_cb(struct cw_ElemHandlerParams * params, uint8_t * elems_ptr, int elems_len)
|
||||||
|
{
|
||||||
|
struct cw_Conn * conn = (struct cw_Conn*)params->conn;
|
||||||
|
char filename[200];
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
cw_dbg(DBG_X,"UPDATE Callback");
|
||||||
|
copy(params);
|
||||||
|
|
||||||
|
const char * wtpname = cw_cfg_get(conn->local_cfg,"wtp-name","default");
|
||||||
|
sprintf(filename,"wtp-status-%s.ckv",wtpname);
|
||||||
|
cw_cfg_save(filename,params->cfg);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
static setup_complete(struct cw_Conn *conn)
|
||||||
|
{
|
||||||
|
struct wtpman * wtpman = (struct wtpman *)conn->data;
|
||||||
|
// wtpman->pjoin = cw_msgset_set_postprocess(conn->msgset,CAPWAP_MSG_JOIN_REQUEST,join_cb);
|
||||||
|
// wtpman->pupdate = cw_msgset_set_postprocess(conn->msgset,CAPWAP_MSG_CONFIGURATION_STATUS_REQUEST,update_cb);
|
||||||
|
cw_dbg(DBG_X,"SETUP COMPLETE");
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
struct wtpman *wtpman_create(int socklistindex, struct sockaddr *srcaddr,
|
||||||
|
int dtlsmode, cw_Cfg_t * global_cfg)
|
||||||
{
|
{
|
||||||
struct sockaddr dbgaddr;
|
struct sockaddr dbgaddr;
|
||||||
socklen_t dbgaddrl;
|
socklen_t dbgaddrl;
|
||||||
@ -634,7 +679,6 @@ struct wtpman *wtpman_create(int socklistindex, struct sockaddr *srcaddr, int dt
|
|||||||
wtpman = malloc(sizeof(struct wtpman));
|
wtpman = malloc(sizeof(struct wtpman));
|
||||||
if (!wtpman)
|
if (!wtpman)
|
||||||
return 0;
|
return 0;
|
||||||
memset(wtpman, 0, sizeof(struct wtpman));
|
|
||||||
|
|
||||||
if (socklist[socklistindex].type != SOCKLIST_UNICAST_SOCKET) {
|
if (socklist[socklistindex].type != SOCKLIST_UNICAST_SOCKET) {
|
||||||
|
|
||||||
@ -642,8 +686,9 @@ struct wtpman *wtpman_create(int socklistindex, struct sockaddr *srcaddr, int dt
|
|||||||
replyfd = socklist_find_reply_socket(srcaddr, port);
|
replyfd = socklist_find_reply_socket(srcaddr, port);
|
||||||
|
|
||||||
if (replyfd == -1) {
|
if (replyfd == -1) {
|
||||||
cw_log(LOG_ERR, "Can't find reply socket for request from %s",
|
cw_log(LOG_ERR,
|
||||||
sock_addr2str(srcaddr,sock_buf));
|
"Can't find reply socket for request from %s",
|
||||||
|
sock_addr2str(srcaddr, sock_buf));
|
||||||
free(wtpman);
|
free(wtpman);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
@ -651,43 +696,58 @@ struct wtpman *wtpman_create(int socklistindex, struct sockaddr *srcaddr, int dt
|
|||||||
replyfd = socklist[socklistindex].sockfd;
|
replyfd = socklist[socklistindex].sockfd;
|
||||||
}
|
}
|
||||||
|
|
||||||
sockfd = replyfd; /*//socklist[socklistindex].reply_sockfd;*/
|
sockfd = replyfd; /*//socklist[socklistindex].reply_sockfd; */
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
dbgaddrl = sizeof(dbgaddr);
|
dbgaddrl = sizeof(dbgaddr);
|
||||||
getsockname(sockfd, &dbgaddr, &dbgaddrl);
|
getsockname(sockfd, &dbgaddr, &dbgaddrl);
|
||||||
|
|
||||||
cw_dbg(DBG_INFO, "Creating wtpman on socket %d, %s:%d", sockfd,
|
cw_dbg(DBG_INFO, "Creating wtpman on socket %d, %s:%d", sockfd,
|
||||||
sock_addr2str(&dbgaddr,sock_buf), sock_getport(&dbgaddr));
|
sock_addr2str(&dbgaddr, sock_buf), sock_getport(&dbgaddr));
|
||||||
|
|
||||||
|
|
||||||
|
memset(wtpman, 0, sizeof(struct wtpman));
|
||||||
|
|
||||||
wtpman->conn = conn_create(sockfd, srcaddr, 100);
|
wtpman->global_cfg = global_cfg;
|
||||||
wtpman->conn->role = CW_ROLE_AC;
|
|
||||||
|
|
||||||
wtpman->conn->data_sock = socklist[socklistindex].data_sockfd;
|
|
||||||
sock_copyaddr(&wtpman->conn->data_addr, (struct sockaddr *) &wtpman->conn->addr);
|
|
||||||
|
|
||||||
|
wtpman->conn = cw_conn_create(sockfd, srcaddr, 5);
|
||||||
if (!wtpman->conn) {
|
if (!wtpman->conn) {
|
||||||
wtpman_destroy(wtpman);
|
wtpman_destroy(wtpman);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
wtpman->conn->global_cfg = global_cfg;
|
||||||
|
wtpman->conn->local_cfg = cw_cfg_create();
|
||||||
|
wtpman->wtp_cfg = cw_cfg_create();
|
||||||
|
|
||||||
|
|
||||||
|
wtpman->conn->role = CW_ROLE_AC;
|
||||||
|
wtpman->conn->data=wtpman;
|
||||||
|
|
||||||
|
wtpman->conn->data_sock = socklist[socklistindex].data_sockfd;
|
||||||
|
sock_copyaddr(&wtpman->conn->data_addr,
|
||||||
|
(struct sockaddr *) &wtpman->conn->addr);
|
||||||
|
|
||||||
|
cw_conn_set_msg_cb(wtpman->conn,
|
||||||
|
CAPWAP_MSG_DISCOVERY_REQUEST,
|
||||||
|
discovery_cb);
|
||||||
|
|
||||||
|
cw_conn_set_msg_cb(wtpman->conn,
|
||||||
|
CAPWAP_MSG_JOIN_REQUEST,
|
||||||
|
join_cb);
|
||||||
|
|
||||||
|
cw_conn_set_msg_cb(wtpman->conn,
|
||||||
|
CAPWAP_MSG_CONFIGURATION_STATUS_REQUEST,
|
||||||
|
update_cb);
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
// wtpman->conn->mods = conf_mods;
|
||||||
|
|
||||||
|
|
||||||
wtpman->conn->mods = conf_mods;
|
|
||||||
|
|
||||||
wtpman->conn->strict_capwap = conf_strict_capwap;
|
wtpman->conn->strict_capwap = conf_strict_capwap;
|
||||||
wtpman->conn->strict_hdr = conf_strict_headers;
|
wtpman->conn->strict_hdr = conf_strict_headers;
|
||||||
|
|
||||||
|
wtpman->conn->setup_complete = setup_complete;
|
||||||
/*
|
/*
|
||||||
// wtpman->conn->radios = mbag_i_create();
|
// wtpman->conn->radios = mbag_i_create();
|
||||||
// wtpman->conn->radios_upd = mbag_i_create();
|
// wtpman->conn->radios_upd = mbag_i_create();
|
||||||
@ -698,45 +758,46 @@ struct wtpman *wtpman_create(int socklistindex, struct sockaddr *srcaddr, int dt
|
|||||||
*/
|
*/
|
||||||
|
|
||||||
|
|
||||||
wtpman->conn->local_cfg = cw_ktv_create();
|
|
||||||
wtpman->conn->global_cfg = actube_global_cfg;
|
|
||||||
wtpman->conn->local_cfg = actube_global_cfg;
|
|
||||||
|
|
||||||
/* when created caused by a packet in DTLS mode, we try
|
/* when created caused by a packet in DTLS mode, we try
|
||||||
* to find out the modules to load, for detected connection
|
* to find out the modules to load, for detected connection
|
||||||
* from discovery request */
|
* from discovery request */
|
||||||
if (dtlsmode){
|
if (dtlsmode) {
|
||||||
int rc;
|
int rc;
|
||||||
struct cw_Mod *cmod, *bmod;
|
struct cw_Mod *cmod, *bmod;
|
||||||
|
|
||||||
rc = discovery_cache_get(discovery_cache,srcaddr,&cmod,&bmod);
|
rc = discovery_cache_get(discovery_cache, srcaddr, &cmod,
|
||||||
if (rc){
|
&bmod);
|
||||||
cw_dbg(DBG_INFO, "Initializing with mod %s %s",cmod->name,bmod->name);
|
if (rc) {
|
||||||
wtpman->conn->msgset = cw_mod_get_msg_set(wtpman->conn,cmod,bmod);
|
cw_dbg(DBG_INFO, "Initializing with mod %s %s",
|
||||||
wtpman->conn->detected=1;
|
cmod->name, bmod->name);
|
||||||
|
wtpman->conn->msgset =
|
||||||
|
cw_mod_get_msg_set(wtpman->conn, cmod, bmod);
|
||||||
|
wtpman->conn->detected = 1;
|
||||||
cmod->setup_cfg(wtpman->conn);
|
cmod->setup_cfg(wtpman->conn);
|
||||||
|
if (wtpman->conn->setup_complete)
|
||||||
|
wtpman->conn->setup_complete(wtpman->conn);
|
||||||
|
|
||||||
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
cw_dbg(DBG_X,"WTPMAN_CREATED: %p",wtpman);
|
||||||
|
|
||||||
return wtpman;
|
return wtpman;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
void wtpman_addpacket(struct wtpman *wtpman, uint8_t * packet, int len)
|
void wtpman_addpacket(struct wtpman *wtpman, uint8_t * packet, int len)
|
||||||
{
|
{
|
||||||
|
// cw_dbg(DBG_X,"ADD PACKET DETECTED %d",wtpman->conn->detected);
|
||||||
conn_q_add_packet(wtpman->conn, packet, len);
|
conn_q_add_packet(wtpman->conn, packet, len);
|
||||||
}
|
}
|
||||||
|
|
||||||
void wtpman_start(struct wtpman *wtpman, int dtlsmode)
|
void wtpman_start(struct wtpman *wtpman, int dtlsmode)
|
||||||
{
|
{
|
||||||
cw_dbg(DBG_INFO, "Starting wtpman, DTLS mode = %d",dtlsmode);
|
cw_dbg(DBG_INFO, "Starting wtpman, DTLS mode = %d", dtlsmode);
|
||||||
wtpman->dtlsmode=dtlsmode;
|
wtpman->dtlsmode = dtlsmode;
|
||||||
pthread_create(&wtpman->thread, NULL, wtpman_main,
|
pthread_create(&wtpman->thread, NULL, wtpman_main, (void *) wtpman);
|
||||||
(void *) wtpman);
|
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
@ -8,19 +8,21 @@
|
|||||||
#include "cw/capwap.h"
|
#include "cw/capwap.h"
|
||||||
#include "cw/fragman.h"
|
#include "cw/fragman.h"
|
||||||
#include "cw/timer.h"
|
#include "cw/timer.h"
|
||||||
|
#include "cw/cfg.h"
|
||||||
|
#include "cw/capwap.h"
|
||||||
|
|
||||||
#define WTPMAN_QSIZE 1024
|
#define WTPMAN_QSIZE 1024
|
||||||
|
|
||||||
struct wtpman{
|
struct wtpman {
|
||||||
pthread_t thread;
|
pthread_t thread;
|
||||||
|
|
||||||
struct conn * conn;
|
struct cw_Conn *conn;
|
||||||
|
|
||||||
|
|
||||||
/* wtp data */
|
/* wtp data */
|
||||||
uint8_t * wtp_name;
|
uint8_t *wtp_name;
|
||||||
uint8_t * wtp_location;
|
uint8_t *wtp_location;
|
||||||
uint8_t * session_id;
|
uint8_t *session_id;
|
||||||
uint8_t wtp_mactype;
|
uint8_t wtp_mactype;
|
||||||
|
|
||||||
int socklistindex;
|
int socklistindex;
|
||||||
@ -30,6 +32,15 @@ struct wtpman{
|
|||||||
|
|
||||||
cw_timer_t echointerval_timer;
|
cw_timer_t echointerval_timer;
|
||||||
|
|
||||||
|
cw_Cfg_t * global_cfg; /**< contains the cfg of AC,
|
||||||
|
visible to all wtpman threads.
|
||||||
|
The global cfg was initally read
|
||||||
|
from a .ckv file on startup.
|
||||||
|
*/
|
||||||
|
|
||||||
|
cw_Cfg_t * wtp_cfg;
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
};
|
};
|
||||||
|
|
||||||
@ -43,13 +54,14 @@ struct wtp{
|
|||||||
//extern void wtpman_run(void *arg);
|
//extern void wtpman_run(void *arg);
|
||||||
*/
|
*/
|
||||||
|
|
||||||
struct wtpman * wtpman_create();
|
struct wtpman *wtpman_create();
|
||||||
|
|
||||||
struct wtpman * wtpman_create(int socklistindex,struct sockaddr * srcaddr, int dtlsmode);
|
struct wtpman *wtpman_create(int socklistindex, struct sockaddr *srcaddr,
|
||||||
|
int dtlsmode, cw_Cfg_t * global_cfg);
|
||||||
|
|
||||||
extern void wtpman_addpacket(struct wtpman * wtpman,uint8_t *packet,int len);
|
extern void wtpman_addpacket(struct wtpman *wtpman, uint8_t * packet, int len);
|
||||||
extern void wtpman_destroy(struct wtpman * wtpman);
|
extern void wtpman_destroy(struct wtpman *wtpman);
|
||||||
extern void wtpman_start(struct wtpman * wtpman,int dtlsmode);
|
extern void wtpman_start(struct wtpman *wtpman, int dtlsmode);
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
@ -1,6 +1,6 @@
|
|||||||
#!/bin/sh
|
#!/bin/sh
|
||||||
|
|
||||||
VERSION="1.1.0a"
|
VERSION="1.2.0"
|
||||||
|
|
||||||
wget -O libmavl-${VERSION}.tgz ftp://ftp.planix.org/pub/planix/libmavl-${VERSION}.tgz
|
wget -O libmavl-${VERSION}.tgz ftp://ftp.planix.org/pub/planix/libmavl-${VERSION}.tgz
|
||||||
tar xzvf libmavl-${VERSION}.tgz
|
tar xzvf libmavl-${VERSION}.tgz
|
||||||
|
@ -1743,7 +1743,7 @@ RTF_EXTENSIONS_FILE =
|
|||||||
# classes and files.
|
# classes and files.
|
||||||
# The default value is: NO.
|
# The default value is: NO.
|
||||||
|
|
||||||
GENERATE_MAN = NO
|
GENERATE_MAN = YES
|
||||||
|
|
||||||
# The MAN_OUTPUT tag is used to specify where the man pages will be put. If a
|
# The MAN_OUTPUT tag is used to specify where the man pages will be put. If a
|
||||||
# relative path is entered the value of OUTPUT_DIRECTORY will be put in front of
|
# relative path is entered the value of OUTPUT_DIRECTORY will be put in front of
|
||||||
@ -1770,7 +1770,7 @@ MAN_EXTENSION = .3
|
|||||||
# The default value is: NO.
|
# The default value is: NO.
|
||||||
# This tag requires that the tag GENERATE_MAN is set to YES.
|
# This tag requires that the tag GENERATE_MAN is set to YES.
|
||||||
|
|
||||||
MAN_LINKS = NO
|
MAN_LINKS = YES
|
||||||
|
|
||||||
#---------------------------------------------------------------------------
|
#---------------------------------------------------------------------------
|
||||||
# Configuration options related to the XML output
|
# Configuration options related to the XML output
|
||||||
|
@ -3,6 +3,7 @@ MFDEPS=../Defs.mak
|
|||||||
|
|
||||||
|
|
||||||
CWSRC=\
|
CWSRC=\
|
||||||
|
cw.c\
|
||||||
cw_check_missing_mand.c\
|
cw_check_missing_mand.c\
|
||||||
cw_clock_lap.c\
|
cw_clock_lap.c\
|
||||||
cw_dbg_elem.c\
|
cw_dbg_elem.c\
|
||||||
@ -16,13 +17,6 @@ CWSRC=\
|
|||||||
cw_in_ac_name_with_priority.c\
|
cw_in_ac_name_with_priority.c\
|
||||||
cw_in_capwap_local_ipv4_address.c\
|
cw_in_capwap_local_ipv4_address.c\
|
||||||
cw_in_capwap_local_ipv6_address.c\
|
cw_in_capwap_local_ipv6_address.c\
|
||||||
cw_in_check_cfg_update_req.c\
|
|
||||||
cw_in_check_disc_req.c\
|
|
||||||
cw_in_check_img_data_req_ac.c\
|
|
||||||
cw_in_check_img_data_req_wtp.c\
|
|
||||||
cw_in_check_join_req.c\
|
|
||||||
cw_in_check_join_resp.c\
|
|
||||||
cw_in_generic.c\
|
|
||||||
cw_in_generic_with_index.c\
|
cw_in_generic_with_index.c\
|
||||||
cw_in_generic_struct.c\
|
cw_in_generic_struct.c\
|
||||||
cw_in_radio_generic_struct.c\
|
cw_in_radio_generic_struct.c\
|
||||||
@ -38,15 +32,12 @@ CWSRC=\
|
|||||||
cw_in_wtp_reboot_statistics.c\
|
cw_in_wtp_reboot_statistics.c\
|
||||||
cw_is_printable.c\
|
cw_is_printable.c\
|
||||||
cw_load_file.c\
|
cw_load_file.c\
|
||||||
cw_out_generic.c\
|
|
||||||
cw_out_generic_with_index.c\
|
cw_out_generic_with_index.c\
|
||||||
cw_out_radio_administrative_states.c\
|
cw_out_radio_administrative_states.c\
|
||||||
cw_process_element.c\
|
|
||||||
cw_put_elem_radio_administrative_state.c\
|
cw_put_elem_radio_administrative_state.c\
|
||||||
cw_put_elem_radio_operational_state.c\
|
cw_put_elem_radio_operational_state.c\
|
||||||
cw_put_image_data.c\
|
cw_put_image_data.c\
|
||||||
cw_put_local_ip_address.c\
|
cw_put_local_ip_address.c\
|
||||||
cw_put_msg.c\
|
|
||||||
cw_radio_set_admin_state.c\
|
cw_radio_set_admin_state.c\
|
||||||
cw_rand.c\
|
cw_rand.c\
|
||||||
cw_randint.c\
|
cw_randint.c\
|
||||||
@ -68,13 +59,24 @@ CWSRC=\
|
|||||||
cw_type_bool.c\
|
cw_type_bool.c\
|
||||||
cw_type_str.c\
|
cw_type_str.c\
|
||||||
cw_type_dword.c\
|
cw_type_dword.c\
|
||||||
|
cw_type_struct.c\
|
||||||
cw_type_ipaddress.c\
|
cw_type_ipaddress.c\
|
||||||
cw_type_word.c\
|
cw_type_word.c\
|
||||||
cw_type_sysptr.c\
|
cw_type_sysptr.c\
|
||||||
cw_write_descriptor_subelem.c\
|
cw_write_descriptor_subelem.c\
|
||||||
cw_read_from.c \
|
|
||||||
cw_write_radio_element.c\
|
cw_write_radio_element.c\
|
||||||
cw_detect_nat.c\
|
cw_detect_nat.c\
|
||||||
|
cw_read_from.c \
|
||||||
|
|
||||||
|
# cw_in_check_disc_req.c\
|
||||||
|
# cw_in_check_img_data_req_ac.c\
|
||||||
|
# cw_in_check_img_data_req_wtp.c\
|
||||||
|
# cw_in_check_join_req.c\
|
||||||
|
# cw_in_check_join_resp.c\
|
||||||
|
# cw_in_generic.c\
|
||||||
|
# cw_out_generic.c\
|
||||||
|
#
|
||||||
|
# cw_process_element.c\
|
||||||
|
|
||||||
KTVSRC=\
|
KTVSRC=\
|
||||||
cw_ktv_add.c\
|
cw_ktv_add.c\
|
||||||
@ -101,12 +103,12 @@ KTVSRC=\
|
|||||||
cw_ktv_read_struct.c\
|
cw_ktv_read_struct.c\
|
||||||
cw_ktv_write_struct.c\
|
cw_ktv_write_struct.c\
|
||||||
cw_ktv_std_types.c\
|
cw_ktv_std_types.c\
|
||||||
cw_ktv_base_exists.c\
|
|
||||||
cw_ktv_save.c\
|
cw_ktv_save.c\
|
||||||
cw_ktv_del_sub.c\
|
|
||||||
cw_ktv_parser.c\
|
|
||||||
cfg.c\
|
cfg.c\
|
||||||
|
|
||||||
|
# cw_ktv_parser.c\
|
||||||
|
# cw_ktv_del_sub.c\
|
||||||
|
# cw_ktv_base_exists.c\
|
||||||
|
|
||||||
LWSRC=\
|
LWSRC=\
|
||||||
lw_addelem.c\
|
lw_addelem.c\
|
||||||
@ -176,35 +178,42 @@ MISCSRC=\
|
|||||||
capwap_strings_result.c\
|
capwap_strings_result.c\
|
||||||
capwap_strings_state.c\
|
capwap_strings_state.c\
|
||||||
capwap_strings_vendor.c\
|
capwap_strings_vendor.c\
|
||||||
conn_create.c\
|
|
||||||
conn_create_noq.c\
|
conn_create_noq.c\
|
||||||
conn_destroy.c\
|
|
||||||
conn_init.c\
|
|
||||||
connlist.c\
|
connlist.c\
|
||||||
conn_prepare_image_data_request.c\
|
conn_prepare_image_data_request.c\
|
||||||
conn_process_packet.c\
|
|
||||||
cw_decode_msg.c \
|
|
||||||
conn_q_add_packet.c\
|
conn_q_add_packet.c\
|
||||||
conn_q_get_packet.c\
|
conn_q_get_packet.c\
|
||||||
conn_q_wait_packet.c\
|
|
||||||
conn_q_recv_packet.c\
|
conn_q_recv_packet.c\
|
||||||
conn_recv_packet.c\
|
conn_recv_packet.c\
|
||||||
conn_send_data_packet.c\
|
conn_send_data_packet.c\
|
||||||
conn_send_msg.c\
|
conn_send_msg.c\
|
||||||
conn_send_packet.c\
|
conn_send_packet.c\
|
||||||
conn_send_request.c\
|
|
||||||
dot11.c\
|
dot11.c\
|
||||||
dot11_inline.c\
|
dot11_inline.c\
|
||||||
format.c\
|
format.c\
|
||||||
format_is_utf8.c\
|
format_is_utf8.c\
|
||||||
fragman.c\
|
fragman.c\
|
||||||
intavltree.c\
|
|
||||||
md5sum.c\
|
md5sum.c\
|
||||||
mod.c\
|
mod.c\
|
||||||
msgset.c\
|
msgset.c\
|
||||||
netconn.c\
|
|
||||||
send.c\
|
send.c\
|
||||||
strheap.c\
|
strheap.c\
|
||||||
|
netconn.c\
|
||||||
|
conn.c \
|
||||||
|
val.c \
|
||||||
|
discovery.c\
|
||||||
|
message.c\
|
||||||
|
|
||||||
|
|
||||||
|
# intavltree.c\
|
||||||
|
|
||||||
|
# conn_q_wait_packet.c\
|
||||||
|
# conn_init.c\
|
||||||
|
# conn_create.c\
|
||||||
|
# conn_send_request.c\
|
||||||
|
# cw_put_msg.c\
|
||||||
|
# conn_process_packet.c\
|
||||||
|
# conn_destroy.c\
|
||||||
|
|
||||||
DTLSSRC+=\
|
DTLSSRC+=\
|
||||||
dtls_bio.c\
|
dtls_bio.c\
|
||||||
@ -212,9 +221,10 @@ DTLSSRC+=\
|
|||||||
|
|
||||||
|
|
||||||
RADIOSRC=\
|
RADIOSRC=\
|
||||||
cw_out_radio_generic.c\
|
|
||||||
cw_out_radio_generic_struct.c\
|
cw_out_radio_generic_struct.c\
|
||||||
cw_read_radio_generic.c\
|
|
||||||
|
# cw_in_radio_generic.c\
|
||||||
|
# cw_out_radio_generic.c\
|
||||||
|
|
||||||
MAVLSRC=\
|
MAVLSRC=\
|
||||||
mavl_get_ptr.c\
|
mavl_get_ptr.c\
|
||||||
@ -265,3 +275,6 @@ dynamic: $(DNAME)
|
|||||||
|
|
||||||
include ../lib.mk
|
include ../lib.mk
|
||||||
|
|
||||||
|
depend:
|
||||||
|
mkdep -c ${CFLAGS} ${SOURCES}
|
||||||
|
|
||||||
|
@ -140,7 +140,7 @@ static inline int bstr16_ncpy(uint8_t *dst,uint8_t*src,uint16_t len)
|
|||||||
|
|
||||||
|
|
||||||
bstr16_t bstr16_create(const uint8_t *data, uint16_t len);
|
bstr16_t bstr16_create(const uint8_t *data, uint16_t len);
|
||||||
uint8_t * bstr16_create_from_str(const char *s);
|
bstr16_t bstr16_create_from_str(const char *s);
|
||||||
extern uint8_t * bstr16_create_from_cfgstr(const char * s);
|
extern uint8_t * bstr16_create_from_cfgstr(const char * s);
|
||||||
|
|
||||||
#define bstr16_replace bstr_replace
|
#define bstr16_replace bstr_replace
|
||||||
|
@ -2,7 +2,7 @@
|
|||||||
#include "format.h"
|
#include "format.h"
|
||||||
|
|
||||||
|
|
||||||
uint8_t * bstr16_create_from_str(const char *s)
|
bstr16_t bstr16_create_from_str(const char *s)
|
||||||
{
|
{
|
||||||
uint8_t * mem;
|
uint8_t * mem;
|
||||||
int msize;
|
int msize;
|
||||||
|
@ -1,18 +0,0 @@
|
|||||||
#include "bstr.h"
|
|
||||||
|
|
||||||
/*
|
|
||||||
uint8_t * bstrv_create(uint32_t vendor_id, uint8_t *data, uint8_t len)
|
|
||||||
{
|
|
||||||
uint8_t * str = malloc(bstrv_size(len));
|
|
||||||
if (!str)
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
bstrv_set_vendor_id(str,vendor_id);
|
|
||||||
bstrv_set_len(str,len);
|
|
||||||
memcpy(bstrv_data(str),data,len);
|
|
||||||
*(bstrv_data(str)+bstrv_len(str))=0;
|
|
||||||
return str;
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
*/
|
|
@ -641,14 +641,10 @@ struct cw_ac_status {
|
|||||||
*/
|
*/
|
||||||
enum capwap_states {
|
enum capwap_states {
|
||||||
CW_STATE_NONE = 0,
|
CW_STATE_NONE = 0,
|
||||||
/** Discovery State */
|
CAPWAP_STATE_DISCOVERY, /**< Discovery State */
|
||||||
CAPWAP_STATE_DISCOVERY,
|
CAPWAP_STATE_JOIN, /**< Join State */
|
||||||
/** Join State */
|
|
||||||
CAPWAP_STATE_JOIN,
|
|
||||||
CAPWAP_STATE_JOIN_COMPLETE,
|
CAPWAP_STATE_JOIN_COMPLETE,
|
||||||
|
CAPWAP_STATE_CONFIGURE, /**< Config State */
|
||||||
/** Config State */
|
|
||||||
CAPWAP_STATE_CONFIGURE,
|
|
||||||
CAPWAP_STATE_DTLS_SETUP, /**< DTLS Setup */
|
CAPWAP_STATE_DTLS_SETUP, /**< DTLS Setup */
|
||||||
/** Image Data Upload */
|
/** Image Data Upload */
|
||||||
CW_STATE_IMAGE_DATA,
|
CW_STATE_IMAGE_DATA,
|
||||||
|
@ -2,15 +2,15 @@
|
|||||||
#include "capwap.h"
|
#include "capwap.h"
|
||||||
|
|
||||||
struct cw_StrListElem capwap_strings_state[] = {
|
struct cw_StrListElem capwap_strings_state[] = {
|
||||||
{ CAPWAP_STATE_DISCOVERY, "Discovery" },
|
{ CW_STATE_NONE, "None"},
|
||||||
{ CAPWAP_STATE_JOIN,"Join" },
|
{ CAPWAP_STATE_DISCOVERY, "Discovery" },
|
||||||
{ CAPWAP_STATE_RUN,"Run" },
|
{ CAPWAP_STATE_JOIN,"Join" },
|
||||||
{ CAPWAP_STATE_CONFIGURE,"Configure" },
|
{ CAPWAP_STATE_RUN,"Run" },
|
||||||
{ CW_STATE_IMAGE_DATA,"Image Data" },
|
{ CAPWAP_STATE_CONFIGURE,"Configure" },
|
||||||
{ CAPWAP_STATE_DTLS_SETUP, "DTLS Setup" },
|
{ CW_STATE_IMAGE_DATA,"Image Data" },
|
||||||
{ CAPWAP_STATE_DATA_CHECK, "Data Check" },
|
{ CAPWAP_STATE_DTLS_SETUP, "DTLS Setup" },
|
||||||
{ CAPWAP_STATE_TIMEOUT, "Timeout"},
|
{ CAPWAP_STATE_DATA_CHECK, "Data Check" },
|
||||||
{ CW_STR_STOP,"Undefined" },
|
{ CAPWAP_STATE_TIMEOUT, "Timeout"},
|
||||||
|
{ CW_STR_STOP,"Undefined" },
|
||||||
};
|
};
|
||||||
|
|
||||||
|
649
src/cw/cfg.c
649
src/cw/cfg.c
@ -3,33 +3,93 @@
|
|||||||
|
|
||||||
#include <mavl.h>
|
#include <mavl.h>
|
||||||
|
|
||||||
#include "cw.h"
|
|
||||||
#include "cfg.h"
|
|
||||||
#include "val.h"
|
#include "val.h"
|
||||||
|
#include "cfg.h"
|
||||||
|
|
||||||
static int cmp(const void *k1,const void*k2){
|
|
||||||
struct cw_Cfg_entry * e1,*e2;
|
#include "dbg.h"
|
||||||
e1=(struct cw_Cfg_entry *)k1;
|
#include "log.h"
|
||||||
e2=(struct cw_Cfg_entry *)k2;
|
#include "cw.h"
|
||||||
return strcmp(e1->key,e2->key);
|
|
||||||
|
static const char *nextc(const char *s)
|
||||||
|
{
|
||||||
|
while (isdigit(*s))
|
||||||
|
s++;
|
||||||
|
return s;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int cmp0(const char *s1, const char *s2)
|
||||||
|
{
|
||||||
|
|
||||||
|
const char *d1, *d2;
|
||||||
|
int i1, i2, i;
|
||||||
|
|
||||||
|
d1 = strchr(s1, '.');
|
||||||
|
if (d1 == NULL)
|
||||||
|
return strcmp(s1, s2);
|
||||||
|
|
||||||
|
d2 = strchr(s2, '.');
|
||||||
|
if (d2 == NULL)
|
||||||
|
return strcmp(s1, s2);
|
||||||
|
|
||||||
|
if ((d1 - s1) != (d2 - s2))
|
||||||
|
return strcmp(s1, s2);
|
||||||
|
|
||||||
|
if (strncmp(s1, s2, (d1 - s1)) != 0)
|
||||||
|
return strcmp(s1, s2);
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
if (isdigit(d1[1])) {
|
||||||
|
i1 = atoi(d1 + 1);
|
||||||
|
} else {
|
||||||
|
return cmp0(d1 + 1, d2 + 1);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (isdigit(d2[1])) {
|
||||||
|
i2 = atoi(d2 + 1);
|
||||||
|
} else {
|
||||||
|
return cmp0(d1 + 1, d2 + 1);
|
||||||
|
}
|
||||||
|
|
||||||
|
i = i1 - i2;
|
||||||
|
if (i == 0) {
|
||||||
|
return cmp0(nextc(d1 + 1), nextc(d2 + 1));
|
||||||
|
}
|
||||||
|
return i;
|
||||||
|
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
static int cmp(const void *k1, const void *k2)
|
||||||
|
{
|
||||||
|
struct cw_Cfg_entry *e1, *e2;
|
||||||
|
e1 = (struct cw_Cfg_entry *) k1;
|
||||||
|
e2 = (struct cw_Cfg_entry *) k2;
|
||||||
|
|
||||||
|
|
||||||
|
return cmp0(e1->key, e2->key);
|
||||||
|
/* return strcmp(e1->key,e2->key);*/
|
||||||
}
|
}
|
||||||
|
|
||||||
static void del(void *ptr)
|
static void del(void *ptr)
|
||||||
{
|
{
|
||||||
struct cw_Cfg_entry * e;
|
struct cw_Cfg_entry *e;
|
||||||
e=(struct cw_Cfg_entry *)ptr;
|
e = (struct cw_Cfg_entry *) ptr;
|
||||||
free(e->key);
|
free((void *) e->key);
|
||||||
free(e->val);
|
free((void *) e->val);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
cw_Cfg_t * cw_cfg_create()
|
cw_Cfg_t *cw_cfg_create()
|
||||||
{
|
{
|
||||||
return mavl_create(cmp, del, sizeof(struct cw_Cfg_entry));
|
return mavl_create(cmp, del, sizeof(struct cw_Cfg_entry));
|
||||||
}
|
}
|
||||||
|
|
||||||
int cw_cfg_set(cw_Cfg_t * cfg,const char *key, const char *val)
|
int cw_cfg_set(cw_Cfg_t * cfg, const char *key, const char *val)
|
||||||
{
|
{
|
||||||
|
cw_dbg(DBG_CFG_SET, "%s: %s",key,val);
|
||||||
|
|
||||||
struct cw_Cfg_entry e;
|
struct cw_Cfg_entry e;
|
||||||
int replaced;
|
int replaced;
|
||||||
|
|
||||||
@ -37,12 +97,12 @@ int cw_cfg_set(cw_Cfg_t * cfg,const char *key, const char *val)
|
|||||||
if (!e.key)
|
if (!e.key)
|
||||||
return 0;
|
return 0;
|
||||||
e.val = cw_strdup(val);
|
e.val = cw_strdup(val);
|
||||||
if (!e.val){
|
if (!e.val) {
|
||||||
free(e.key);
|
free((void *) e.key);
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
void * rc = mavl_replace(cfg,&e,&replaced);
|
void *rc = mavl_replace(cfg, &e, &replaced);
|
||||||
if (!rc){
|
if (!rc) {
|
||||||
del(&e);
|
del(&e);
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
@ -52,32 +112,66 @@ int cw_cfg_set(cw_Cfg_t * cfg,const char *key, const char *val)
|
|||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
char * cw_cfg_get(cw_Cfg_t * cfg, char *key)
|
const char *cw_cfg_get(cw_Cfg_t * cfg, const char *key, const char *def)
|
||||||
{
|
{
|
||||||
struct cw_Cfg_entry e,*r;
|
struct cw_Cfg_entry e, *r;
|
||||||
e.key = key;
|
e.key = key;
|
||||||
r = mavl_get(cfg,&e);
|
r = mavl_get(cfg, &e);
|
||||||
if (!r)
|
if (!r)
|
||||||
return NULL;
|
return def;
|
||||||
return r->val;
|
return r->val;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
const char *cw_cfg_get_l(cw_Cfg_t ** cfg, const char * key, const char *def)
|
||||||
uint16_t cw_cfg_get_word(cw_Cfg_t * cfg, char *key)
|
|
||||||
{
|
{
|
||||||
|
int i;
|
||||||
|
struct cw_Cfg_entry e, *r;
|
||||||
|
for(i=0; cfg[i]!=NULL; i++){
|
||||||
|
// cw_dbg(DBG_X,"GET_L IN: %p",cfg[i]);
|
||||||
|
e.key = key;
|
||||||
|
r = mavl_get(cfg[i], &e);
|
||||||
|
if (r!=NULL)
|
||||||
|
return r->val;
|
||||||
|
}
|
||||||
|
return def;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
void cw_cfg_dump(cw_Cfg_t *cfg)
|
const char *cw_cfg_get2(cw_Cfg_t *cfg1, cw_Cfg_t *cfg2, const char *key, const char *def)
|
||||||
|
{
|
||||||
|
return cw_cfg_get(cfg1, key, cw_cfg_get(cfg2,key,def));
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
bstr16_t cw_cfg_get_bstr16(cw_Cfg_t * cfg, const char * key, const char *def)
|
||||||
|
{
|
||||||
|
const char *s;
|
||||||
|
|
||||||
|
s = cw_cfg_get(cfg,key,def);
|
||||||
|
if(s==NULL)
|
||||||
|
return NULL;
|
||||||
|
|
||||||
|
return bstr16_create_from_str(s);
|
||||||
|
}
|
||||||
|
|
||||||
|
int cw_cfg_set_bstr16(cw_Cfg_t * cfg, const char * key, bstr16_t str)
|
||||||
|
{
|
||||||
|
CW_TYPE_BSTR16->read(cfg,key,bstr16_data(str),bstr16_len(str),NULL);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
void cw_cfg_dump(cw_Cfg_t * cfg)
|
||||||
{
|
{
|
||||||
mavliter_t it;
|
mavliter_t it;
|
||||||
struct cw_Cfg_entry *e;
|
struct cw_Cfg_entry *e;
|
||||||
mavliter_init(&it,cfg);
|
mavliter_init(&it, cfg);
|
||||||
mavliter_foreach(&it){
|
mavliter_foreach(&it) {
|
||||||
|
|
||||||
e = mavliter_get(&it);
|
e = mavliter_get(&it);
|
||||||
printf("%s: '%s'\n",e->key,e->val);
|
printf("%s: '%s'\n", e->key, e->val);
|
||||||
//cw_dbg(dbglevel,"%s%s :%s: %s",prefix,data->key,type->get_type_name(data), value);
|
//cw_dbg(dbglevel,"%s%s :%s: %s",prefix,data->key,type->get_type_name(data), value);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@ -97,23 +191,23 @@ struct parser {
|
|||||||
static int get_char(struct parser *p)
|
static int get_char(struct parser *p)
|
||||||
{
|
{
|
||||||
int c;
|
int c;
|
||||||
c = fgetc (p->f);
|
c = fgetc(p->f);
|
||||||
p->pos++;
|
p->pos++;
|
||||||
if (c=='\n'){
|
if (c == '\n') {
|
||||||
p->prevpos=p->pos;
|
p->prevpos = p->pos;
|
||||||
p->line ++;
|
p->line++;
|
||||||
p->pos=0;
|
p->pos = 0;
|
||||||
}
|
}
|
||||||
return c;
|
return c;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void unget_char(struct parser *p,int c){
|
static void unget_char(struct parser *p, int c)
|
||||||
ungetc(c,p->f);
|
{
|
||||||
if (c=='\n'){
|
ungetc(c, p->f);
|
||||||
|
if (c == '\n') {
|
||||||
p->line--;
|
p->line--;
|
||||||
p->pos=p->prevpos;
|
p->pos = p->prevpos;
|
||||||
}
|
} else
|
||||||
else
|
|
||||||
p->pos--;
|
p->pos--;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -123,17 +217,17 @@ static int get_char_q(struct parser *p)
|
|||||||
{
|
{
|
||||||
int c;
|
int c;
|
||||||
|
|
||||||
while(1) {
|
while (1) {
|
||||||
c = get_char(p);
|
c = get_char(p);
|
||||||
if (c==EOF || c=='\n')
|
if (c == EOF || c == '\n')
|
||||||
return c;
|
return c;
|
||||||
|
|
||||||
if(c=='"' && !p->quote){
|
if (c == '"' && !p->quote) {
|
||||||
p->quote=1;
|
p->quote = 1;
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
if(c=='"' && p->quote){
|
if (c == '"' && p->quote) {
|
||||||
p->quote=0;
|
p->quote = 0;
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
@ -143,11 +237,11 @@ static int get_char_q(struct parser *p)
|
|||||||
if (!p->quote)
|
if (!p->quote)
|
||||||
return c;
|
return c;
|
||||||
|
|
||||||
if (c!='\\')
|
if (c != '\\')
|
||||||
return c;
|
return c;
|
||||||
|
|
||||||
c = get_char(p);
|
c = get_char(p);
|
||||||
switch(c){
|
switch (c) {
|
||||||
case EOF:
|
case EOF:
|
||||||
return c;
|
return c;
|
||||||
case 'n':
|
case 'n':
|
||||||
@ -158,32 +252,32 @@ static int get_char_q(struct parser *p)
|
|||||||
case '"':
|
case '"':
|
||||||
return '"';
|
return '"';
|
||||||
default:
|
default:
|
||||||
unget_char(p,c);
|
unget_char(p, c);
|
||||||
return '\\';
|
return '\\';
|
||||||
}
|
}
|
||||||
|
|
||||||
/* We will never reach here */
|
/* We will never reach here */
|
||||||
/* return c;*/
|
/* return c; */
|
||||||
}
|
}
|
||||||
|
|
||||||
static int skip_chars (struct parser *p, const char * chars)
|
static int skip_chars(struct parser *p, const char *chars)
|
||||||
{
|
{
|
||||||
int c;
|
int c;
|
||||||
|
|
||||||
while ( (c = get_char (p)) != EOF) {
|
while ((c = get_char(p)) != EOF) {
|
||||||
if (strchr (chars, c))
|
if (strchr(chars, c))
|
||||||
continue;
|
continue;
|
||||||
return c;
|
return c;
|
||||||
}
|
}
|
||||||
return c;
|
return c;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int skip_to_chars (struct parser *p, const char *chars)
|
static int skip_to_chars(struct parser *p, const char *chars)
|
||||||
{
|
{
|
||||||
int c;
|
int c;
|
||||||
|
|
||||||
while ( (c = get_char (p)) != EOF) {
|
while ((c = get_char(p)) != EOF) {
|
||||||
if (strchr (chars, c))
|
if (strchr(chars, c))
|
||||||
return c;
|
return c;
|
||||||
}
|
}
|
||||||
return c;
|
return c;
|
||||||
@ -191,52 +285,56 @@ static int skip_to_chars (struct parser *p, const char *chars)
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
static int read_key (struct parser *p, char *key, int max_len)
|
static int read_key(struct parser *p, char *key, int max_len)
|
||||||
{
|
{
|
||||||
int c,n;
|
int c, n;
|
||||||
|
|
||||||
do {
|
do {
|
||||||
c = skip_chars (p, " \t\n\a\v");
|
c = skip_chars(p, " \t\n\a\v");
|
||||||
if (c == '#') {
|
if (c == '#') {
|
||||||
c = skip_to_chars (p, "\n\a");
|
c = skip_to_chars(p, "\n\a");
|
||||||
|
|
||||||
} else {
|
} else {
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
} while (c != EOF);
|
} while (c != EOF);
|
||||||
|
|
||||||
unget_char(p,c);
|
unget_char(p, c);
|
||||||
c=get_char_q(p);
|
c = get_char_q(p);
|
||||||
|
|
||||||
n=0;
|
n = 0;
|
||||||
while(c!=EOF && n<max_len){
|
while (c != EOF && n < max_len) {
|
||||||
if (!p->quote && !isalnum(c) && !strchr("._/-()@#|{}[]\\",c)/*strchr(": \t\n\a",c)*/){
|
if (!p->quote && !isalnum(c)
|
||||||
unget_char(p,c);
|
&& !strchr("._/-()@#|{}[]\\", c) /*strchr(": \t\n\a",c) */ ) {
|
||||||
|
unget_char(p, c);
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
key[n]=c;
|
key[n] = c;
|
||||||
|
|
||||||
c=get_char_q(p);
|
c = get_char_q(p);
|
||||||
n++;
|
n++;
|
||||||
|
|
||||||
}
|
}
|
||||||
key[n]=0;
|
key[n] = 0;
|
||||||
return n;
|
return n;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
static int skip_to_colon(FILE *f,struct parser * p)
|
static int skip_to_colon(FILE * f, struct parser *p)
|
||||||
{
|
{
|
||||||
int c;
|
int c;
|
||||||
c = skip_chars (p, " \t");
|
c = skip_chars(p, " \t");
|
||||||
if (c!=':'){
|
if (c != ':') {
|
||||||
if (c=='\n'){
|
if (c == '\n') {
|
||||||
unget_char(p,c);
|
unget_char(p, c);
|
||||||
sprintf(p->error,"Error at line %d, pos %d: Unexpected EOL, collon expected.", p->line, p->pos);
|
sprintf(p->error,
|
||||||
|
"Error at line %d, pos %d: Unexpected EOL, collon expected.",
|
||||||
|
p->line, p->pos);
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
sprintf(p->error,"Error at line %d, pos %d: Collon expected.", p->line, p->pos);
|
sprintf(p->error, "Error at line %d, pos %d: Collon expected.",
|
||||||
|
p->line, p->pos);
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
return 1;
|
return 1;
|
||||||
@ -244,58 +342,58 @@ static int skip_to_colon(FILE *f,struct parser * p)
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
static int read_val(struct parser *p, char *val, int max_len){
|
static int read_val(struct parser *p, char *val, int max_len)
|
||||||
int c,n,quote;
|
{
|
||||||
if (!skip_to_colon(p->f,p))
|
int c, n, quote;
|
||||||
|
if (!skip_to_colon(p->f, p))
|
||||||
return -1;
|
return -1;
|
||||||
c = skip_chars (p, " \t");
|
c = skip_chars(p, " \t");
|
||||||
if (c=='"'){
|
if (c == '"') {
|
||||||
quote=1;
|
quote = 1;
|
||||||
c=get_char(p);
|
c = get_char(p);
|
||||||
|
} else {
|
||||||
|
quote = 0;
|
||||||
}
|
}
|
||||||
else{
|
n = 0;
|
||||||
quote=0;
|
while (c != EOF && n < max_len) {
|
||||||
}
|
if (quote && c == '"') {
|
||||||
n=0;
|
|
||||||
while(c!=EOF && n<max_len){
|
|
||||||
if (quote && c=='"'){
|
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
if (c=='\n'){
|
if (c == '\n') {
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
if (quote){
|
if (quote) {
|
||||||
if (c=='\\'){
|
if (c == '\\') {
|
||||||
c = get_char(p);
|
c = get_char(p);
|
||||||
switch(c){
|
switch (c) {
|
||||||
case 'n':
|
case 'n':
|
||||||
c='\n';
|
c = '\n';
|
||||||
break;
|
break;
|
||||||
case '\\':
|
case '\\':
|
||||||
break;
|
break;
|
||||||
case '"':
|
case '"':
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
unget_char(p,c);
|
unget_char(p, c);
|
||||||
c='\\';
|
c = '\\';
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
val[n++]=c;
|
val[n++] = c;
|
||||||
c=get_char(p);
|
c = get_char(p);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
if(!quote && n>0){
|
if (!quote && n > 0) {
|
||||||
while(n>0){
|
while (n > 0) {
|
||||||
if (isspace(val[n-1]))
|
if (isspace(val[n - 1]))
|
||||||
n--;
|
n--;
|
||||||
else
|
else
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
val[n]=0;
|
val[n] = 0;
|
||||||
|
|
||||||
return n;
|
return n;
|
||||||
|
|
||||||
@ -303,20 +401,20 @@ static int read_val(struct parser *p, char *val, int max_len){
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
int cw_cfg_read_line (FILE *f, struct parser *p, char * key, char *val)
|
int cw_cfg_read_line(FILE * f, struct parser *p, char *key, char *val)
|
||||||
{
|
{
|
||||||
int n;
|
int n;
|
||||||
|
|
||||||
|
|
||||||
n = read_key (p,key,CW_CFG_MAX_KEY_LEN);
|
n = read_key(p, key, CW_CFG_MAX_KEY_LEN);
|
||||||
if (n==0)
|
if (n == 0)
|
||||||
return 1;
|
return 1;
|
||||||
if (n==-1){
|
if (n == -1) {
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
n = read_val (p,val,CW_CFG_MAX_KEY_LEN);
|
n = read_val(p, val, CW_CFG_MAX_KEY_LEN);
|
||||||
if (n==-1){
|
if (n == -1) {
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
return 0;
|
return 0;
|
||||||
@ -328,45 +426,348 @@ int cw_cfg_read_from_file(FILE * f, cw_Cfg_t * cfg)
|
|||||||
char val[2048];
|
char val[2048];
|
||||||
struct parser p;
|
struct parser p;
|
||||||
|
|
||||||
p.line=1;
|
p.line = 1;
|
||||||
p.pos=0;
|
p.pos = 0;
|
||||||
p.prevpos=0;
|
p.prevpos = 0;
|
||||||
p.quote=0;
|
p.quote = 0;
|
||||||
p.f=f;
|
p.f = f;
|
||||||
|
|
||||||
int rc;
|
int rc;
|
||||||
int errs=0;
|
int errs = 0;
|
||||||
|
|
||||||
|
|
||||||
do {
|
do {
|
||||||
|
|
||||||
rc = cw_cfg_read_line(f,&p,key,val);
|
rc = cw_cfg_read_line(f, &p, key, val);
|
||||||
if (rc==-1){
|
if (rc == -1) {
|
||||||
fprintf(stderr,"Error: %s\n",p.error);
|
fprintf(stderr, "Error: %s\n", p.error);
|
||||||
errs++;
|
errs++;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
if (rc != 0){
|
if (rc != 0) {
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
|
|
||||||
cw_cfg_set(cfg,key,val);
|
cw_cfg_set(cfg, key, val);
|
||||||
|
|
||||||
|
|
||||||
}while(rc==0);
|
} while (rc == 0);
|
||||||
|
|
||||||
return errs;
|
return errs;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
int cw_cfg_load(const char *filename, cw_Cfg_t * cfg)
|
||||||
int cw_cfg_load(const char *filename,cw_Cfg_t * cfg)
|
|
||||||
{
|
{
|
||||||
int errs;
|
int errs;
|
||||||
FILE *f = fopen(filename,"rb");
|
FILE *f = fopen(filename, "rb");
|
||||||
if (!f)
|
if (!f)
|
||||||
return errno;
|
return errno;
|
||||||
errs = cw_cfg_read_from_file(f,cfg);
|
errs = cw_cfg_read_from_file(f, cfg);
|
||||||
fclose(f);
|
fclose(f);
|
||||||
return errs;
|
|
||||||
|
if (errs)
|
||||||
|
errno = EINVAL;
|
||||||
|
return errno;
|
||||||
|
}
|
||||||
|
|
||||||
|
int cw_cfg_write_to_file(FILE *f, cw_Cfg_t * cfg)
|
||||||
|
{
|
||||||
|
mavliter_t it;
|
||||||
|
struct cw_Cfg_entry *e;
|
||||||
|
mavliter_init(&it, cfg);
|
||||||
|
mavliter_foreach(&it) {
|
||||||
|
int n;
|
||||||
|
e = mavliter_get(&it);
|
||||||
|
n=strlen(e->val);
|
||||||
|
if (n>0)
|
||||||
|
n-=1;
|
||||||
|
|
||||||
|
//printf("Write %s: \"%s\" - %d %d (%02x)\n",e->key,e->val,n,isspace(e->val[n]),e->val[n]);
|
||||||
|
if(isspace(e->val[0]) || isspace(e->val[n]))
|
||||||
|
fprintf(f,"%s: \"%s\"\n", e->key, e->val);
|
||||||
|
else
|
||||||
|
fprintf(f,"%s: %s\n", e->key, e->val);
|
||||||
|
|
||||||
|
//cw_dbg(dbglevel,"%s%s :%s: %s",prefix,data->key,type->get_type_name(data), value);
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
int cw_cfg_save(const char *filename, cw_Cfg_t *cfg)
|
||||||
|
{
|
||||||
|
int rc;
|
||||||
|
FILE *f = fopen(filename, "wb");
|
||||||
|
if (!f)
|
||||||
|
return errno;
|
||||||
|
rc = cw_cfg_write_to_file(f, cfg);
|
||||||
|
fclose(f);
|
||||||
|
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void cw_cfg_iter_init(cw_Cfg_t * cfg, struct cw_Cfg_iter *cfi, const char *base)
|
||||||
|
{
|
||||||
|
struct cw_Cfg_entry search;
|
||||||
|
search.key = base;
|
||||||
|
|
||||||
|
mavliter_init(&(cfi->it), cfg);
|
||||||
|
mavliter_seek(&(cfi->it), &search, 0);
|
||||||
|
cfi->base = base;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
const char *cw_cfg_iter_next(struct cw_Cfg_iter *cfi, const char *key)
|
||||||
|
{
|
||||||
|
struct cw_Cfg_entry *e;
|
||||||
|
int bl, kl;
|
||||||
|
const char *d;
|
||||||
|
|
||||||
|
e = mavliter_get(&(cfi->it));
|
||||||
|
if (e == NULL)
|
||||||
|
return NULL;
|
||||||
|
|
||||||
|
|
||||||
|
bl = strlen(cfi->base);
|
||||||
|
kl = strlen(e->key);
|
||||||
|
|
||||||
|
if (bl > kl)
|
||||||
|
return NULL;
|
||||||
|
|
||||||
|
if (bl == kl) {
|
||||||
|
if (strcmp(cfi->base, e->key) != 0)
|
||||||
|
return NULL;
|
||||||
|
else {
|
||||||
|
mavliter_next(&(cfi->it));
|
||||||
|
return e->val;
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
|
d = strchr(e->key, '.');
|
||||||
|
if (d == NULL)
|
||||||
|
return NULL;
|
||||||
|
|
||||||
|
if (d - e->key != bl)
|
||||||
|
return NULL;
|
||||||
|
|
||||||
|
if (strncmp(cfi->base, e->key, bl) != 0)
|
||||||
|
return NULL;
|
||||||
|
|
||||||
|
mavliter_next(&(cfi->it));
|
||||||
|
return e->val;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
int cw_cfg_get_bool(cw_Cfg_t * cfg, const char * key, int def)
|
||||||
|
{
|
||||||
|
struct cw_Val v;
|
||||||
|
const char *s = cw_cfg_get(cfg,key,NULL);
|
||||||
|
if (s==NULL)
|
||||||
|
return def;
|
||||||
|
CW_TYPE_BOOL->from_str(&v,s);
|
||||||
|
return v.val.boolean;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
uint8_t cw_cfg_get_byte(cw_Cfg_t * cfg, char *key, uint8_t def)
|
||||||
|
{
|
||||||
|
struct cw_Val v;
|
||||||
|
memset(&v,0,sizeof(struct cw_Val));
|
||||||
|
const char *s = cw_cfg_get(cfg,key,NULL);
|
||||||
|
if (s==NULL)
|
||||||
|
return def;
|
||||||
|
CW_TYPE_BYTE->from_str(&v,s);
|
||||||
|
return v.val.byte;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t cw_cfg_get_byte_l(cw_Cfg_t ** cfgs, char *key, uint8_t def)
|
||||||
|
{
|
||||||
|
struct cw_Val v;
|
||||||
|
memset(&v,0,sizeof(struct cw_Val));
|
||||||
|
const char *s = cw_cfg_get_l(cfgs,key,NULL);
|
||||||
|
if (s==NULL)
|
||||||
|
return def;
|
||||||
|
CW_TYPE_BYTE->from_str(&v,s);
|
||||||
|
return v.val.byte;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
uint16_t cw_cfg_get_word(cw_Cfg_t * cfg, char *key, uint16_t def)
|
||||||
|
{
|
||||||
|
struct cw_Val v;
|
||||||
|
const char *s = cw_cfg_get(cfg,key,NULL);
|
||||||
|
if (s==NULL)
|
||||||
|
return def;
|
||||||
|
CW_TYPE_WORD->from_str(&v,s);
|
||||||
|
return v.val.word;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
int cw_cfg_get_word(cw_Cfg_t * cfg, char *key, const char * def)
|
||||||
|
{
|
||||||
|
const char *s;
|
||||||
|
s=cw_cfg_get(cfg,key,def);
|
||||||
|
if (s==NULL)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
}
|
||||||
|
*/
|
||||||
|
|
||||||
|
void cw_cfg_set_int(cw_Cfg_t * cfg, const char * key, int val)
|
||||||
|
{
|
||||||
|
char a[128];
|
||||||
|
sprintf(a,"%d",val);
|
||||||
|
cw_cfg_set(cfg,key,a);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
int cw_cfg_get_next_index(cw_Cfg_t * cfg, const char *key)
|
||||||
|
{
|
||||||
|
char ikey[CW_CFG_MAX_KEY_LEN];
|
||||||
|
struct cw_Cfg_entry search, * result;
|
||||||
|
char *d;
|
||||||
|
|
||||||
|
sprintf(ikey,"%s.%d",key,65536);
|
||||||
|
|
||||||
|
search.key=ikey;
|
||||||
|
/*//result = ktvn(ktv,&search);*/
|
||||||
|
|
||||||
|
result = mavl_get_last(cfg,&search);
|
||||||
|
if (result == NULL){
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
d = strchr(result->key,'.');
|
||||||
|
if (d==NULL){
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (strncmp(result->key,ikey,d-result->key)!=0)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
return atoi(d+1)+1;
|
||||||
|
}
|
||||||
|
|
||||||
|
int cw_cfg_set_val(cw_Cfg_t * cfg, const char *key, const struct cw_Type *type, const void * valguard, const uint8_t * data, int len)
|
||||||
|
{
|
||||||
|
cw_Val_t mdata, *mresult;
|
||||||
|
char str[2048];
|
||||||
|
memset(&mdata,0,sizeof(cw_Val_t));
|
||||||
|
mdata.type=type;
|
||||||
|
mdata.valguard=valguard;
|
||||||
|
mresult = type->get(&mdata,data,len);
|
||||||
|
if (!mresult){
|
||||||
|
cw_log(LOG_ERR, "Can't create cfg element for key %s of type %s: %s",
|
||||||
|
key,type->name, strerror(errno));
|
||||||
|
free(mdata.key);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
type->to_str(&mdata,str,2048);
|
||||||
|
cw_cfg_set(cfg,key,str);
|
||||||
|
|
||||||
|
if (type->del)
|
||||||
|
type->del(&mdata);
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
//int cw_cfg_put(cw_Cfg_t *cfg, const char *key, const struct cw_Type *type,const void
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
void cw_cfg_copy(cw_Cfg_t *src, cw_Cfg_t *dst)
|
||||||
|
{
|
||||||
|
mavliter_t it;
|
||||||
|
mavliter_init(&it, src);
|
||||||
|
mavliter_foreach(&it) {
|
||||||
|
int exists;
|
||||||
|
struct cw_Cfg_entry * old_elem,*e, new_elem;
|
||||||
|
|
||||||
|
e = mavliter_get(&it);
|
||||||
|
new_elem.key = cw_strdup(e->key);
|
||||||
|
new_elem.val = cw_strdup(e->val);
|
||||||
|
|
||||||
|
old_elem = mavl_insert(dst,&new_elem,&exists);
|
||||||
|
if (!exists){
|
||||||
|
cw_dbg(DBG_X, "New: %s: %s",new_elem.key,new_elem.val);
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
if (strcmp(new_elem.val,old_elem->val)==0){
|
||||||
|
free((void*)new_elem.key);
|
||||||
|
free((void*)new_elem.val);
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
|
cw_dbg(DBG_X, "Replace: %s: %s (old: %s)",new_elem.key, new_elem.val, old_elem->val);
|
||||||
|
if(dst->del){
|
||||||
|
dst->del(old_elem);
|
||||||
|
}
|
||||||
|
memcpy(old_elem,&new_elem,dst->data_size);
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void cw_cfg_destroy(cw_Cfg_t *cfg)
|
||||||
|
{
|
||||||
|
mavl_destroy(cfg);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void cw_cfg_clear(cw_Cfg_t *cfg)
|
||||||
|
{
|
||||||
|
mavl_del_all(cfg);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
int cw_cfg_base_exists(cw_Cfg_t * cfg, const char *key)
|
||||||
|
{
|
||||||
|
struct cw_Cfg_entry e, *result;
|
||||||
|
//cw_dbg(DBG_X,"LOOX FOR: %s",key);
|
||||||
|
e.key=key;
|
||||||
|
result = mavl_get_first(cfg,&e);
|
||||||
|
if (result == NULL)
|
||||||
|
return 0;
|
||||||
|
//cw_dbg(DBG_X,"BASEXXX: %s",result->key);
|
||||||
|
|
||||||
|
if (strlen(result->key)<strlen(key))
|
||||||
|
return 0;
|
||||||
|
//cw_dbg(DBG_X,"BASEXXX1: %d",strlen(key));
|
||||||
|
if (result->key[strlen(key)]!='/' && result->key[strlen(key)]!='.')
|
||||||
|
return 0;
|
||||||
|
//cw_dbg(DBG_X,"BASEXXX2: ");
|
||||||
|
if (strncmp(result->key,key,strlen(key))==0)
|
||||||
|
return 1;
|
||||||
|
cw_dbg(DBG_X,"BASEXXX3: ");
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
int cw_cfg_base_exists_l(cw_Cfg_t ** cfgs, const char *key)
|
||||||
|
{
|
||||||
|
int i;
|
||||||
|
for(i=0; cfgs[i]; i++){
|
||||||
|
if (cw_cfg_base_exists(cfgs[i],key))
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
cw_dbg(DBG_X,"NOX EXISIS: %s in %d",key,i);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
cw_Val_t * cw_cfg_get_val_l(cw_Cfg_t ** cfgs, const char *key, const struct cw_Type *type)
|
||||||
|
{
|
||||||
|
const char *s;
|
||||||
|
cw_Val_t * val;
|
||||||
|
s = cw_cfg_get_l(cfgs,key,NULL);
|
||||||
|
val = malloc(sizeof(cw_Val_t));
|
||||||
|
if (val==NULL)
|
||||||
|
return NULL;
|
||||||
|
val->type=type;
|
||||||
|
val->type->from_str(val,s);
|
||||||
|
return val;
|
||||||
}
|
}
|
||||||
|
47
src/cw/cfg.h
47
src/cw/cfg.h
@ -2,6 +2,8 @@
|
|||||||
#define _CFG_H
|
#define _CFG_H
|
||||||
|
|
||||||
#include <mavl.h>
|
#include <mavl.h>
|
||||||
|
#include "val.h"
|
||||||
|
#include "bstr.h"
|
||||||
|
|
||||||
#define CW_CFG_MAX_KEY_LEN 1024
|
#define CW_CFG_MAX_KEY_LEN 1024
|
||||||
|
|
||||||
@ -14,11 +16,50 @@ int cw_cfg_read_from_file(FILE * file, cw_Cfg_t * cfg);
|
|||||||
int cw_cfg_load(const char *filename,cw_Cfg_t * cfg);
|
int cw_cfg_load(const char *filename,cw_Cfg_t * cfg);
|
||||||
|
|
||||||
struct cw_Cfg_entry{
|
struct cw_Cfg_entry{
|
||||||
char *key;
|
const char *key;
|
||||||
char *val;
|
const char *val;
|
||||||
};
|
};
|
||||||
|
|
||||||
char * cw_cfg_get(cw_Cfg_t * cfg, char *key);
|
|
||||||
|
struct cw_Cfg_iter{
|
||||||
|
struct mavliter it;
|
||||||
|
const char *base;
|
||||||
|
};
|
||||||
|
|
||||||
|
const char * cw_cfg_get(cw_Cfg_t * cfg, const char *key, const char *def);
|
||||||
|
|
||||||
|
const char *cw_cfg_iter_next(struct cw_Cfg_iter *cfi, const char *key);
|
||||||
|
void cw_cfg_iter_init(cw_Cfg_t * cfg, struct cw_Cfg_iter *cfi, const char *base);
|
||||||
|
|
||||||
|
int cw_cfg_get_bool(cw_Cfg_t * cfg, const char * key, int def);
|
||||||
|
uint16_t cw_cfg_get_word(cw_Cfg_t * cfg, char *key, uint16_t def);
|
||||||
|
void cw_cfg_set_int(cw_Cfg_t * cfg, const char * key, int val);
|
||||||
|
uint8_t cw_cfg_get_byte(cw_Cfg_t * cfg, char *key, uint8_t def);
|
||||||
|
bstr16_t cw_cfg_get_bstr16(cw_Cfg_t * cfg, const char * key, const char *def);
|
||||||
|
int cw_cfg_set_bstr16(cw_Cfg_t * cfg, const char * key, bstr16_t str);
|
||||||
|
int cw_cfg_get_next_index(cw_Cfg_t * cfg, const char *key);
|
||||||
|
const char *cw_cfg_get_l(cw_Cfg_t ** cfg, const char * key, const char *def);
|
||||||
|
void cw_cfg_copy(cw_Cfg_t *src, cw_Cfg_t *dst);
|
||||||
|
void cw_cfg_destroy(cw_Cfg_t *cfg);
|
||||||
|
void cw_cfg_clear(cw_Cfg_t *cfg);
|
||||||
|
int cw_cfg_base_exists(cw_Cfg_t * cfg, const char *key);
|
||||||
|
uint8_t cw_cfg_get_byte_l(cw_Cfg_t ** cfgs, char *key, uint8_t def);
|
||||||
|
cw_Val_t * cw_cfg_get_val_l(cw_Cfg_t ** cfgs, const char *key, const struct cw_Type *type);
|
||||||
|
int cw_cfg_base_exists_l(cw_Cfg_t ** cfgs, const char *key);
|
||||||
|
int cw_cfg_save(const char *filename, cw_Cfg_t *cfg);
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
int cw_cfg_set_val(cw_Cfg_t * cfg, const char *key, const struct cw_Type *t, const void * valguard, const uint8_t * data, int len);
|
||||||
|
|
||||||
|
#define cw_cfg_get_word2(cfg1,cfg2,key,def) \
|
||||||
|
cw_cfg_get_word(cfg1,key,cw_cfg_get_word(cfg2,key,def))
|
||||||
|
|
||||||
|
#define cw_dget(fun,cfg1,cfg2,key,def)\
|
||||||
|
fun(cfg1,key,fun(cfg2,key,def))
|
||||||
|
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
@ -1,39 +1,162 @@
|
|||||||
/*
|
#include <string.h>
|
||||||
This file is part of libcapwap.
|
#include <stdint.h>
|
||||||
|
|
||||||
libcapwap is free software: you can redistribute it and/or modify
|
|
||||||
it under the terms of the GNU General Public License as published by
|
|
||||||
the Free Software Foundation, either version 3 of the License, or
|
|
||||||
(at your option) any later version.
|
|
||||||
|
|
||||||
libcapwap is distributed in the hope that it will be useful,
|
#include "conn.h"
|
||||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
#include "capwap.h"
|
||||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
#include "cw.h"
|
||||||
GNU General Public License for more details.
|
|
||||||
|
|
||||||
You should have received a copy of the GNU General Public License
|
|
||||||
along with Foobar. If not, see <http://www.gnu.org/licenses/>.
|
|
||||||
|
|
||||||
*/
|
|
||||||
#include <stdlib.h>
|
#include <stdlib.h>
|
||||||
#include <string.h>
|
#include <string.h>
|
||||||
#include <errno.h>
|
#include <errno.h>
|
||||||
|
|
||||||
#include "cw.h"
|
|
||||||
#include "dbg.h"
|
|
||||||
|
|
||||||
#include "log.h"
|
#include "log.h"
|
||||||
#include "cw_util.h"
|
#include "capwap.h"
|
||||||
|
|
||||||
#include "conn.h"
|
#include "conn.h"
|
||||||
#include "sock.h"
|
#include "sock.h"
|
||||||
|
|
||||||
/*#include "stravltree.h"*/
|
|
||||||
#include "mod.h"
|
|
||||||
#include "msgset.h"
|
#include "msgset.h"
|
||||||
|
#include "cw.h"
|
||||||
|
|
||||||
#include "val.h"
|
|
||||||
|
|
||||||
|
#include "dbg.h"
|
||||||
|
#include "msgset.h"
|
||||||
|
#include "mavltypes.h"
|
||||||
|
|
||||||
|
#include "dtls.h"
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
struct msg_callback{
|
||||||
|
int type; /**< message type */
|
||||||
|
cw_MsgCallbackFun fun;
|
||||||
|
};
|
||||||
|
|
||||||
|
int msg_callback_cmp(const void *v1,const void *v2)
|
||||||
|
{
|
||||||
|
struct msg_callback *t1,*t2;
|
||||||
|
t1=(struct msg_callback*)v1;
|
||||||
|
t2=(struct msg_callback*)v2;
|
||||||
|
return t1->type - t2->type;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Basic initialization of a conn object
|
||||||
|
* @param conn conn object to initialize
|
||||||
|
*/
|
||||||
|
void cw_conn_init(struct cw_Conn * conn)
|
||||||
|
{
|
||||||
|
memset(conn,0,sizeof(struct cw_Conn ));
|
||||||
|
conn->retransmit_interval=CAPWAP_RETRANSMIT_INTERVAL;
|
||||||
|
conn->max_retransmit=CAPWAP_MAX_RETRANSMIT;
|
||||||
|
conn->wait_dtls=CAPWAP_WAIT_DTLS;
|
||||||
|
conn->wait_join=CAPWAP_WAIT_JOIN;
|
||||||
|
conn->mtu_discovery=1;
|
||||||
|
conn->strict_capwap=1;
|
||||||
|
|
||||||
|
conn->process_packet=conn_process_packet;
|
||||||
|
conn->process_message=process_message;
|
||||||
|
|
||||||
|
conn->msg_callbacks = mavl_create(msg_callback_cmp,NULL,sizeof(struct msg_callback));
|
||||||
|
|
||||||
|
conn->update_cfg = cw_cfg_create();
|
||||||
|
cw_dbg(DBG_X,"Update CFG ist %p",conn->update_cfg);
|
||||||
|
conn->remote_cfg = cw_cfg_create();
|
||||||
|
conn->local_cfg = cw_cfg_create();
|
||||||
|
}
|
||||||
|
|
||||||
|
int cw_conn_set_msg_cb(struct cw_Conn *conn, int type, cw_MsgCallbackFun fun)
|
||||||
|
{
|
||||||
|
struct msg_callback cb;
|
||||||
|
int exists;
|
||||||
|
|
||||||
|
cb.type = type;
|
||||||
|
cb.fun = fun;
|
||||||
|
mavl_insert(conn->msg_callbacks,&cb,&exists);
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
cw_MsgCallbackFun cw_conn_get_msg_cb(struct cw_Conn *conn, int type)
|
||||||
|
{
|
||||||
|
struct msg_callback cb,*result;
|
||||||
|
cb.type=type;
|
||||||
|
result = mavl_get(conn->msg_callbacks,&cb);
|
||||||
|
if (result == NULL)
|
||||||
|
return NULL;
|
||||||
|
return result->fun;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Create a conn object
|
||||||
|
* @param sock a socket
|
||||||
|
* @param addr the address associated
|
||||||
|
* @param qsize size of packet queue
|
||||||
|
* @return A pointer to the created object
|
||||||
|
* This function creates a conn obnject with queueing functionality
|
||||||
|
* for asynchronous operation.
|
||||||
|
* To create a conn object without queue functionallity use #conn_create_noq.
|
||||||
|
*/
|
||||||
|
struct cw_Conn * cw_conn_create(int sock, struct sockaddr * addr, int qsize)
|
||||||
|
{
|
||||||
|
struct cw_Conn * conn;
|
||||||
|
conn = malloc(sizeof (struct cw_Conn ));
|
||||||
|
if (!conn)
|
||||||
|
return NULL;
|
||||||
|
|
||||||
|
cw_conn_init(conn);
|
||||||
|
|
||||||
|
conn->sock=sock;
|
||||||
|
|
||||||
|
if (addr)
|
||||||
|
sock_copyaddr(&conn->addr,addr);
|
||||||
|
|
||||||
|
|
||||||
|
conn->fragman = fragman_create();
|
||||||
|
if (conn->fragman==NULL){
|
||||||
|
conn_destroy(conn);
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
conn->qsize=qsize;
|
||||||
|
if (qsize != 0){
|
||||||
|
if (!(conn->q=malloc( sizeof(uint8_t *) * qsize))){
|
||||||
|
conn_destroy(conn);
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
conn->qrpos=-1;
|
||||||
|
if (sem_init(&conn->q_sem,0,0)!=0){
|
||||||
|
cw_log(LOG_ERR,"Fatal- Can't init semaphore for conn object: %s",strerror(errno));
|
||||||
|
conn_destroy(conn);
|
||||||
|
return NULL;
|
||||||
|
};
|
||||||
|
conn->recv_packet=conn_q_recv_packet;
|
||||||
|
conn->recv_packet_peek=conn_q_recv_packet_peek;
|
||||||
|
}
|
||||||
|
else{
|
||||||
|
conn->recv_packet = conn_recv_packet;
|
||||||
|
conn->recv_packet_peek = conn_recv_packet_peek;
|
||||||
|
}
|
||||||
|
|
||||||
|
conn->send_packet = conn_send_packet;
|
||||||
|
/* conn->send_data_packet = conn_send_data_packet;*/
|
||||||
|
|
||||||
|
conn->last_seqnum_received=-1;
|
||||||
|
conn->mtu=600;
|
||||||
|
|
||||||
|
|
||||||
|
conn->cur_packet=0;
|
||||||
|
conn->recv_timeout=1;
|
||||||
|
|
||||||
|
conn->seqnum=-1;
|
||||||
|
conn->write = conn->send_packet;
|
||||||
|
conn->read = conn->recv_packet;
|
||||||
|
|
||||||
|
conn->dtls_mtu = 600;
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
return conn;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
@ -42,7 +165,7 @@
|
|||||||
/**
|
/**
|
||||||
* Init response message header
|
* Init response message header
|
||||||
*/
|
*/
|
||||||
void cw_init_response(struct conn *conn, uint8_t * req)
|
void cw_init_response(struct cw_Conn *conn, uint8_t * req)
|
||||||
{
|
{
|
||||||
uint8_t *buffer;
|
uint8_t *buffer;
|
||||||
int shbytes, dhbytes;
|
int shbytes, dhbytes;
|
||||||
@ -69,7 +192,7 @@ void cw_init_response(struct conn *conn, uint8_t * req)
|
|||||||
cw_set_msg_flags(dmsgptr, 0);
|
cw_set_msg_flags(dmsgptr, 0);
|
||||||
}
|
}
|
||||||
|
|
||||||
void cw_init_request(struct conn *conn, int msg_id)
|
void cw_init_request(struct cw_Conn *conn, int msg_id)
|
||||||
{
|
{
|
||||||
uint8_t *buffer = conn->req_buffer;
|
uint8_t *buffer = conn->req_buffer;
|
||||||
uint8_t *msgptr;
|
uint8_t *msgptr;
|
||||||
@ -97,7 +220,7 @@ void cw_init_request(struct conn *conn, int msg_id)
|
|||||||
cw_set_msg_elems_len(msgptr, 0);
|
cw_set_msg_elems_len(msgptr, 0);
|
||||||
}
|
}
|
||||||
|
|
||||||
void cw_init_data_msg(struct conn *conn)
|
void cw_init_data_msg(struct cw_Conn *conn)
|
||||||
{
|
{
|
||||||
uint8_t *buffer = conn->req_buffer;
|
uint8_t *buffer = conn->req_buffer;
|
||||||
cw_set_dword(buffer + 0, 0);
|
cw_set_dword(buffer + 0, 0);
|
||||||
@ -114,11 +237,11 @@ void cw_init_data_msg(struct conn *conn)
|
|||||||
/**
|
/**
|
||||||
* send a response
|
* send a response
|
||||||
*/
|
*/
|
||||||
int cw_send_response(struct conn *conn, uint8_t * rawmsg, int len)
|
int cw_send_response(struct cw_Conn *conn, uint8_t * rawmsg, int len)
|
||||||
{
|
{
|
||||||
int rc;
|
int rc;
|
||||||
cw_init_response(conn, rawmsg);
|
cw_init_response(conn, rawmsg);
|
||||||
rc = cw_put_msg(conn, conn->resp_buffer);
|
rc = cw_compose_message(conn, conn->resp_buffer);
|
||||||
if (!cw_result_is_ok(rc))
|
if (!cw_result_is_ok(rc))
|
||||||
return 0;
|
return 0;
|
||||||
conn_send_msg(conn, conn->resp_buffer);
|
conn_send_msg(conn, conn->resp_buffer);
|
||||||
@ -135,9 +258,10 @@ int cw_send_response(struct conn *conn, uint8_t * rawmsg, int len)
|
|||||||
* @param result_code result code to send
|
* @param result_code result code to send
|
||||||
* @return 1
|
* @return 1
|
||||||
*/
|
*/
|
||||||
int cw_send_error_response(struct conn *conn, uint8_t * rawmsg, uint32_t result_code)
|
int cw_send_error_response(struct cw_Conn *conn, uint8_t * rawmsg,
|
||||||
|
uint32_t result_code)
|
||||||
{
|
{
|
||||||
uint8_t *out,*dst;
|
uint8_t *out, *dst;
|
||||||
int l;
|
int l;
|
||||||
|
|
||||||
cw_init_response(conn, rawmsg);
|
cw_init_response(conn, rawmsg);
|
||||||
@ -155,23 +279,26 @@ int cw_send_error_response(struct conn *conn, uint8_t * rawmsg, uint32_t result_
|
|||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
static struct cw_MsgSet *load_msg_set(struct conn *conn, uint8_t * rawmsg, int len,
|
static struct cw_MsgSet *load_msg_set(struct cw_Conn *conn, uint8_t * rawmsg,
|
||||||
int elems_len, struct sockaddr *from)
|
int len, int elems_len,
|
||||||
|
struct sockaddr *from)
|
||||||
{
|
{
|
||||||
char sock_buf[SOCK_ADDR_BUFSIZE];
|
char sock_buf[SOCK_ADDR_BUFSIZE];
|
||||||
struct cw_Mod *cmod, *bmod;
|
struct cw_Mod *cmod, *bmod;
|
||||||
|
|
||||||
cmod =
|
cmod =
|
||||||
cw_mod_detect(conn, rawmsg, len, elems_len, from, CW_MOD_MODE_CAPWAP);
|
cw_mod_detect(conn, rawmsg, len, elems_len, from,
|
||||||
|
CW_MOD_MODE_CAPWAP);
|
||||||
if (cmod == MOD_NULL) {
|
if (cmod == MOD_NULL) {
|
||||||
cw_dbg(DBG_MSG_ERR,
|
cw_dbg(DBG_MSG_ERR,
|
||||||
"Can't find mod to handle connection from %s, discarding message",
|
"Can't find mod to handle connection from %s, discarding message",
|
||||||
sock_addr2str_p(from,sock_buf));
|
sock_addr2str_p(from, sock_buf));
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
bmod =
|
bmod =
|
||||||
cw_mod_detect(conn, rawmsg, len, elems_len, from, CW_MOD_MODE_BINDINGS);
|
cw_mod_detect(conn, rawmsg, len, elems_len, from,
|
||||||
|
CW_MOD_MODE_BINDINGS);
|
||||||
|
|
||||||
|
|
||||||
cw_dbg(DBG_INFO, "Mods deteced: %s,%s", cmod->name, bmod->name);
|
cw_dbg(DBG_INFO, "Mods deteced: %s,%s", cmod->name, bmod->name);
|
||||||
@ -179,12 +306,12 @@ static struct cw_MsgSet *load_msg_set(struct conn *conn, uint8_t * rawmsg, int l
|
|||||||
conn->cmod = cmod;
|
conn->cmod = cmod;
|
||||||
conn->bmod = bmod;
|
conn->bmod = bmod;
|
||||||
|
|
||||||
return cw_mod_get_msg_set(conn,cmod,bmod);
|
return cw_mod_get_msg_set(conn, cmod, bmod);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
int cw_in_check_generic(struct conn *conn, struct cw_action_in *a, uint8_t * data,
|
int cw_in_check_generic(struct cw_Conn *conn, struct cw_action_in *a, uint8_t * data,
|
||||||
int len,struct sockaddr *from)
|
int len,struct sockaddr *from)
|
||||||
{
|
{
|
||||||
// if (cw_is_request(a->msg_id)){
|
// if (cw_is_request(a->msg_id)){
|
||||||
@ -196,37 +323,21 @@ int cw_in_check_generic(struct conn *conn, struct cw_action_in *a, uint8_t * dat
|
|||||||
}
|
}
|
||||||
*/
|
*/
|
||||||
|
|
||||||
/*
|
|
||||||
void cw_read_elem(struct cw_ElemHandler * handler, struct conn * conn,
|
|
||||||
uint8_t * elem_data, int elem_len, struct sockaddr * from){
|
|
||||||
mavldata_t data, *result;
|
|
||||||
char str[30];
|
|
||||||
|
|
||||||
result = handler->type->get(&data,elem_data,elem_len);
|
static int process_elements(struct cw_Conn *conn, uint8_t * rawmsg, int len,
|
||||||
|
|
||||||
handler->type->to_str(result,str,30);
|
|
||||||
printf("Read %d-%s: %s %s\n", handler->id, handler->name, handler->key, str);
|
|
||||||
//mavl_insert(conn->remote_cfg
|
|
||||||
}
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
static int process_elements(struct conn *conn, uint8_t * rawmsg, int len,
|
|
||||||
struct sockaddr *from)
|
struct sockaddr *from)
|
||||||
{
|
{
|
||||||
mavl_t mand_found;
|
|
||||||
mlist_t unrecognized;
|
|
||||||
struct cw_MsgData search;
|
struct cw_MsgData search;
|
||||||
struct cw_MsgData * message;
|
struct cw_MsgData *message;
|
||||||
int result_code;
|
int result_code;
|
||||||
cw_State_t *ui;
|
cw_State_t *ui;
|
||||||
|
|
||||||
uint8_t *elems_ptr;
|
uint8_t *elems_ptr;
|
||||||
uint8_t *elem;
|
struct cw_ElemHandlerParams params;
|
||||||
|
|
||||||
char sock_buf[SOCK_ADDR_BUFSIZE]; /**< to hold str from sockaddr2str */
|
char sock_buf[SOCK_ADDR_BUFSIZE]; /**< to hold str from sockaddr2str */
|
||||||
|
|
||||||
/*struct cw_action_in as, *af, *afm;*/
|
/*struct cw_action_in as, *af, *afm; */
|
||||||
|
|
||||||
int offset = cw_get_hdr_msg_offset(rawmsg);
|
int offset = cw_get_hdr_msg_offset(rawmsg);
|
||||||
|
|
||||||
@ -243,7 +354,8 @@ static int process_elements(struct conn *conn, uint8_t * rawmsg, int len,
|
|||||||
if (conn->strict_hdr) {
|
if (conn->strict_hdr) {
|
||||||
cw_dbg(DBG_MSG_ERR,
|
cw_dbg(DBG_MSG_ERR,
|
||||||
"Discarding message from %s, msgelems len=%d, payload len=%d, (Strict CAPWAP) ",
|
"Discarding message from %s, msgelems len=%d, payload len=%d, (Strict CAPWAP) ",
|
||||||
sock_addr2str(&conn->addr,sock_buf), elems_len, payloadlen - 8);
|
sock_addr2str(&conn->addr, sock_buf), elems_len,
|
||||||
|
payloadlen - 8);
|
||||||
errno = EAGAIN;
|
errno = EAGAIN;
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
@ -252,7 +364,8 @@ static int process_elements(struct conn *conn, uint8_t * rawmsg, int len,
|
|||||||
if (elems_len < payloadlen - 8) {
|
if (elems_len < payloadlen - 8) {
|
||||||
cw_dbg(DBG_RFC,
|
cw_dbg(DBG_RFC,
|
||||||
"Packet from from %s has %d bytes of extra data, ignoring.",
|
"Packet from from %s has %d bytes of extra data, ignoring.",
|
||||||
sock_addr2str(&conn->addr,sock_buf), payloadlen - 8 - elems_len);
|
sock_addr2str(&conn->addr, sock_buf),
|
||||||
|
payloadlen - 8 - elems_len);
|
||||||
elems_len = len - 8;
|
elems_len = len - 8;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -260,16 +373,18 @@ static int process_elements(struct conn *conn, uint8_t * rawmsg, int len,
|
|||||||
|
|
||||||
cw_dbg(DBG_RFC,
|
cw_dbg(DBG_RFC,
|
||||||
"Packet from from %s has msgelems len of %d bytes, but has only %d bytes of data, truncating.",
|
"Packet from from %s has msgelems len of %d bytes, but has only %d bytes of data, truncating.",
|
||||||
sock_addr2str(&conn->addr, sock_buf), elems_len, payloadlen - 8);
|
sock_addr2str(&conn->addr, sock_buf), elems_len,
|
||||||
|
payloadlen - 8);
|
||||||
elems_len = payloadlen - 8;
|
elems_len = payloadlen - 8;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/* Detect the connecting AC type */
|
/* Detect the connecting WTP type */
|
||||||
if (!conn->detected) {
|
if (!conn->detected) {
|
||||||
|
|
||||||
struct cw_MsgSet *set = load_msg_set(conn, rawmsg, len, elems_len, from);
|
struct cw_MsgSet *set =
|
||||||
|
load_msg_set(conn, rawmsg, len, elems_len, from);
|
||||||
if (!set) {
|
if (!set) {
|
||||||
/*
|
/*
|
||||||
//cw_log(LOG_ERR, "Error");
|
//cw_log(LOG_ERR, "Error");
|
||||||
@ -278,8 +393,12 @@ static int process_elements(struct conn *conn, uint8_t * rawmsg, int len,
|
|||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
conn->cmod->setup_cfg(conn);
|
conn->cmod->setup_cfg(conn);
|
||||||
conn->msgset= set;
|
conn->msgset = set;
|
||||||
conn->detected = 1;
|
conn->detected = 1;
|
||||||
|
|
||||||
|
if (conn->setup_complete)
|
||||||
|
conn->setup_complete(conn);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/** debug the received message */
|
/** debug the received message */
|
||||||
@ -290,17 +409,17 @@ static int process_elements(struct conn *conn, uint8_t * rawmsg, int len,
|
|||||||
|
|
||||||
/* Search message */
|
/* Search message */
|
||||||
|
|
||||||
message = mavl_get(conn->msgset->msgdata,&search);
|
message = mavl_get(conn->msgset->msgdata, &search);
|
||||||
|
|
||||||
result_code = 0;
|
result_code = 0;
|
||||||
|
|
||||||
if (!message){
|
if (!message) {
|
||||||
/* Message is unknown */
|
/* Message is unknown */
|
||||||
if (search.type & 1){
|
if (search.type & 1) {
|
||||||
cw_dbg(DBG_MSG_ERR,
|
cw_dbg(DBG_MSG_ERR,
|
||||||
"Message type %d [%s] unrecognized, sending response.",
|
"Message type %d [%s] unrecognized, sending response.",
|
||||||
search.type, cw_strmsg(search.type),
|
search.type, cw_strmsg(search.type),
|
||||||
cw_strstate(conn->capwap_state));
|
cw_strstate(conn->capwap_state));
|
||||||
|
|
||||||
result_code = CAPWAP_RESULT_MSG_UNRECOGNIZED;
|
result_code = CAPWAP_RESULT_MSG_UNRECOGNIZED;
|
||||||
cw_send_error_response(conn, rawmsg, result_code);
|
cw_send_error_response(conn, rawmsg, result_code);
|
||||||
@ -308,9 +427,9 @@ static int process_elements(struct conn *conn, uint8_t * rawmsg, int len,
|
|||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
cw_dbg(DBG_MSG_ERR,
|
cw_dbg(DBG_MSG_ERR,
|
||||||
"Message type %d [%s] unrecognized, discarding.",
|
"Message type %d [%s] unrecognized, discarding.",
|
||||||
search.type, cw_strmsg(search.type),
|
search.type, cw_strmsg(search.type),
|
||||||
cw_strstate(conn->capwap_state));
|
cw_strstate(conn->capwap_state));
|
||||||
errno = EAGAIN;
|
errno = EAGAIN;
|
||||||
return -1;
|
return -1;
|
||||||
|
|
||||||
@ -332,18 +451,18 @@ static int process_elements(struct conn *conn, uint8_t * rawmsg, int len,
|
|||||||
/* Check if current state is in state of message */
|
/* Check if current state is in state of message */
|
||||||
ui = message->states;
|
ui = message->states;
|
||||||
|
|
||||||
for (ui=message->states; ui->state; ui++){
|
for (ui = message->states; ui->state; ui++) {
|
||||||
/* printf("Comparing %d and %d\n", conn->capwap_state, ui->state);*/
|
/* printf("Comparing %d and %d\n", conn->capwap_state, ui->state);*/
|
||||||
if(ui->state==conn->capwap_state){
|
if (ui->state == conn->capwap_state) {
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
if (!ui->state){
|
if (!ui->state) {
|
||||||
/* Message found, but it was in wrong state */
|
/* Message found, but it was in wrong state */
|
||||||
cw_dbg(DBG_MSG_ERR,
|
cw_dbg(DBG_MSG_ERR,
|
||||||
"Message type %d (%s) not allowed in %s State, sending response.",
|
"Message type %d (%s) not allowed in %s State, sending response.",
|
||||||
search.type,cw_strmsg(search.type),
|
search.type, cw_strmsg(search.type),
|
||||||
cw_strstate(conn->capwap_state));
|
cw_strstate(conn->capwap_state));
|
||||||
result_code = CAPWAP_RESULT_MSG_INVALID_IN_CURRENT_STATE;
|
result_code = CAPWAP_RESULT_MSG_INVALID_IN_CURRENT_STATE;
|
||||||
cw_send_error_response(conn, rawmsg, result_code);
|
cw_send_error_response(conn, rawmsg, result_code);
|
||||||
@ -353,99 +472,56 @@ static int process_elements(struct conn *conn, uint8_t * rawmsg, int len,
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
/* if (conn->msg_start){
|
|
||||||
conn->msg_start(conn, afm, rawmsg, len, from);
|
|
||||||
}
|
|
||||||
*/
|
|
||||||
/* Execute start processor for message */
|
|
||||||
/*
|
|
||||||
// if (afm->start) {
|
|
||||||
// afm->start(conn, afm, rawmsg, len, from);
|
|
||||||
// }
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
elems_ptr = cw_get_msg_elems_ptr(msg_ptr);
|
elems_ptr = cw_get_msg_elems_ptr(msg_ptr);
|
||||||
|
|
||||||
|
|
||||||
/* Create an avltree to catch the found mandatory elements */
|
cw_dbg(DBG_MSG_PARSING, "*** Parsing message of type %d - (%s) ***",
|
||||||
/* //conn->mand = stravltree_create();*/
|
message->type, message->name);
|
||||||
|
|
||||||
mand_found = mavl_create_conststr();
|
memset(¶ms,0,sizeof(struct cw_ElemHandlerParams));
|
||||||
unrecognized = mlist_create(NULL,NULL,sizeof(uint8_t*));
|
|
||||||
|
|
||||||
cw_dbg(DBG_MSG_PARSING ,"*** Parsing message of type %d - (%s) ***",
|
params.mand_found = mavl_create_conststr();
|
||||||
message->type,message->name);
|
params.unrecognized = mlist_create(NULL, NULL, sizeof(uint8_t *));
|
||||||
/* iterate through message elements */
|
|
||||||
cw_foreach_elem(elem, elems_ptr, elems_len) {
|
|
||||||
int rc;
|
|
||||||
|
|
||||||
struct cw_ElemHandlerParams params;
|
params.cfg = cw_cfg_create();
|
||||||
int elem_len, elem_id, max_len;
|
params.cfg_list[0]=params.cfg;
|
||||||
uint8_t * elem_data;
|
params.cfg_list[1]=conn->local_cfg;
|
||||||
|
params.cfg_list[2]=conn->global_cfg;
|
||||||
|
params.cfg_list[3]=NULL;
|
||||||
|
|
||||||
|
params.from = from;
|
||||||
|
params.msgdata = message;
|
||||||
|
params.msgset=conn->msgset;
|
||||||
|
params.conn = conn;
|
||||||
|
|
||||||
elem_len = cw_get_elem_len(elem);
|
cw_decode_elements(¶ms,elems_ptr, elems_len);
|
||||||
elem_data=cw_get_elem_data(elem);
|
|
||||||
elem_id = cw_get_elem_id(elem);
|
|
||||||
|
|
||||||
max_len=elems_len-(elem_data-elems_ptr);
|
|
||||||
if (elem_len > max_len){
|
|
||||||
cw_dbg(DBG_RFC,
|
|
||||||
"Messag element claims size of %d bytes, but only %d bytes are left in the payload, truncating.",
|
|
||||||
elem_len,max_len-4);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/* params.conn=conn;*/
|
|
||||||
|
|
||||||
params.local_cfg=conn->local_cfg;
|
|
||||||
params.remote_cfg=conn->remote_cfg;
|
|
||||||
params.default_cfg=conn->default_cfg;
|
|
||||||
params.global_cfg=conn->global_cfg;
|
|
||||||
params.msgset=conn->msgset;
|
|
||||||
|
|
||||||
params.from=from;
|
|
||||||
params.msgdata=message;
|
|
||||||
params.mand_found=mand_found;
|
|
||||||
|
|
||||||
rc = cw_process_element(¶ms,0,0,elem_id,elem_data,elem_len);
|
|
||||||
|
|
||||||
|
|
||||||
if (cw_result_is_ok(rc))
|
|
||||||
continue;
|
|
||||||
|
|
||||||
if (rc == CAPWAP_RESULT_UNRECOGNIZED_MESSAGE_ELEMENT){
|
|
||||||
mlist_append(unrecognized,&elem);
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (rc < 0 ){
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
/* all message elements are processed, do now after processing
|
/* all message elements are processed, do now after processing
|
||||||
by calling the "end" function for the message */
|
by calling the "end" function for the message */
|
||||||
|
|
||||||
cw_check_missing_mand(message,mand_found);
|
if (params.mand_found)
|
||||||
|
cw_check_missing_mand(message, params.mand_found,conn->msgset->handlers_by_key);
|
||||||
|
|
||||||
cw_dbg(DBG_MSG_PARSING," *** Done parsing message of type %d (%s) ***",
|
cw_dbg(DBG_MSG_PARSING, "*** End parsing message of type %d (%s) ***",
|
||||||
message->type,message->name);
|
message->type, message->name);
|
||||||
|
|
||||||
mavl_destroy(mand_found);
|
if (params.mand_found)
|
||||||
|
mavl_destroy(params.mand_found);
|
||||||
|
|
||||||
/* cw_dbg_ktv_dump(conn->remote_cfg,DBG_CFG_DMP,
|
if (message->postprocess) {
|
||||||
" *** Remote CFG dump ***", "CFG:", " *** End of remote CFG dump");
|
message->postprocess(¶ms,elems_ptr, elems_len);
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
if (message->postprocess){
|
|
||||||
message->postprocess(conn);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
cw_MsgCallbackFun cb_fun = cw_conn_get_msg_cb(conn,message->type);
|
||||||
|
if (cb_fun != NULL){
|
||||||
|
result_code = cb_fun(¶ms,elems_ptr, elems_len);
|
||||||
|
}
|
||||||
|
else{
|
||||||
|
cw_cfg_clear(conn->update_cfg);
|
||||||
|
}
|
||||||
|
|
||||||
|
// conn->remote_cfg=params.cfg;
|
||||||
|
|
||||||
/* if we've got a request message, we always have to send a response message */
|
/* if we've got a request message, we always have to send a response message */
|
||||||
if (message->type & 1) {
|
if (message->type & 1) {
|
||||||
@ -455,8 +531,9 @@ static int process_elements(struct conn *conn, uint8_t * rawmsg, int len,
|
|||||||
|
|
||||||
cw_send_error_response(conn, rawmsg, result_code);
|
cw_send_error_response(conn, rawmsg, result_code);
|
||||||
} else if (result_code == 0) {
|
} else if (result_code == 0) {
|
||||||
cw_ktv_set_dword(conn->local_cfg,"result-code",result_code);
|
cw_cfg_set_int(conn->update_cfg, "result-code",
|
||||||
if (ui->next){
|
result_code);
|
||||||
|
if (ui->next) {
|
||||||
conn->capwap_prevstate = conn->capwap_state;
|
conn->capwap_prevstate = conn->capwap_state;
|
||||||
conn->capwap_state = ui->next;
|
conn->capwap_state = ui->next;
|
||||||
}
|
}
|
||||||
@ -475,7 +552,10 @@ static int process_elements(struct conn *conn, uint8_t * rawmsg, int len,
|
|||||||
*/
|
*/
|
||||||
}
|
}
|
||||||
|
|
||||||
/*stravltree_destroy(conn->mand);*/
|
if (params.unrecognized)
|
||||||
|
mlist_destroy(params.unrecognized);
|
||||||
|
cw_cfg_destroy(params.cfg);
|
||||||
|
// conn->remote_cfg=NULL;
|
||||||
|
|
||||||
return result_code;
|
return result_code;
|
||||||
|
|
||||||
@ -486,12 +566,12 @@ static int process_elements(struct conn *conn, uint8_t * rawmsg, int len,
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
int process_message(struct conn *conn, uint8_t * rawmsg, int rawlen,
|
int process_message(struct cw_Conn *conn, uint8_t * rawmsg, int rawlen,
|
||||||
struct sockaddr *from)
|
struct sockaddr *from)
|
||||||
{
|
{
|
||||||
char sock_buf[SOCK_ADDR_BUFSIZE];
|
char sock_buf[SOCK_ADDR_BUFSIZE];
|
||||||
uint8_t seqnum;
|
uint8_t seqnum;
|
||||||
int s1,s2,sd;
|
int s1, s2, sd;
|
||||||
|
|
||||||
uint8_t *msgptr = rawmsg + cw_get_hdr_msg_offset(rawmsg);
|
uint8_t *msgptr = rawmsg + cw_get_hdr_msg_offset(rawmsg);
|
||||||
|
|
||||||
@ -522,7 +602,7 @@ int process_message(struct conn *conn, uint8_t * rawmsg, int rawlen,
|
|||||||
if (sd != 0) {
|
if (sd != 0) {
|
||||||
cw_dbg(DBG_MSG_ERR,
|
cw_dbg(DBG_MSG_ERR,
|
||||||
"Discarding message from %s, old seqnum, seqnum = %d, last seqnum=%d",
|
"Discarding message from %s, old seqnum, seqnum = %d, last seqnum=%d",
|
||||||
sock_addr2str(&conn->addr,sock_buf), s2, s1);
|
sock_addr2str(&conn->addr, sock_buf), s2, s1);
|
||||||
errno = EAGAIN;
|
errno = EAGAIN;
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
@ -533,13 +613,13 @@ int process_message(struct conn *conn, uint8_t * rawmsg, int rawlen,
|
|||||||
|
|
||||||
cw_dbg(DBG_MSG_ERR,
|
cw_dbg(DBG_MSG_ERR,
|
||||||
"Retransmitted request message from %s detected, seqnum=%d, type=%d",
|
"Retransmitted request message from %s detected, seqnum=%d, type=%d",
|
||||||
sock_addr2str(&conn->addr,sock_buf), s2, type);
|
sock_addr2str(&conn->addr, sock_buf), s2, type);
|
||||||
|
|
||||||
|
|
||||||
if (cw_get_hdr_msg_type(conn->resp_buffer) - 1 != type) {
|
if (cw_get_hdr_msg_type(conn->resp_buffer) - 1 != type) {
|
||||||
cw_dbg(DBG_MSG_ERR,
|
/* cw_dbg(DBG_MSG_ERR,
|
||||||
"No cached response for retransmission, request seqnum=%d,in cache=%d",
|
"No cached response for retransmission, request seqnum=%d,in cache=%d",
|
||||||
s2, conn->resp_msg.type);
|
s2, conn->resp_msg.type);*/
|
||||||
errno = EAGAIN;
|
errno = EAGAIN;
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
@ -547,7 +627,7 @@ int process_message(struct conn *conn, uint8_t * rawmsg, int rawlen,
|
|||||||
cw_dbg(DBG_MSG_ERR, "Retransmitting response message to %s, seqnum=%d",
|
cw_dbg(DBG_MSG_ERR, "Retransmitting response message to %s, seqnum=%d",
|
||||||
sock_addr2str(&conn->addr, sock_buf), s2);
|
sock_addr2str(&conn->addr, sock_buf), s2);
|
||||||
|
|
||||||
/*// XXX untested*/
|
/*// XXX untested */
|
||||||
conn_send_msg(conn, conn->resp_buffer);
|
conn_send_msg(conn, conn->resp_buffer);
|
||||||
errno = EAGAIN;
|
errno = EAGAIN;
|
||||||
return -1;
|
return -1;
|
||||||
@ -560,8 +640,8 @@ int process_message(struct conn *conn, uint8_t * rawmsg, int rawlen,
|
|||||||
* @param packet pointer to packet data
|
* @param packet pointer to packet data
|
||||||
* @param len lenght of packet data
|
* @param len lenght of packet data
|
||||||
*/
|
*/
|
||||||
int conn_process_packet2(struct conn *conn, uint8_t * packet, int len,
|
int conn_process_packet2(struct cw_Conn *conn, uint8_t * packet, int len,
|
||||||
struct sockaddr *from)
|
struct sockaddr *from)
|
||||||
{
|
{
|
||||||
char sock_buf[SOCK_ADDR_BUFSIZE];
|
char sock_buf[SOCK_ADDR_BUFSIZE];
|
||||||
int preamble;
|
int preamble;
|
||||||
@ -583,8 +663,8 @@ int conn_process_packet2(struct conn *conn, uint8_t * packet, int len,
|
|||||||
/* wrong version */
|
/* wrong version */
|
||||||
cw_dbg(DBG_PKT_ERR,
|
cw_dbg(DBG_PKT_ERR,
|
||||||
"Discarding packet from %s, wrong version, version=%d, version %d expected.",
|
"Discarding packet from %s, wrong version, version=%d, version %d expected.",
|
||||||
sock_addr2str(&conn->addr,sock_buf), (preamble & 0xf0) >> 4,
|
sock_addr2str(&conn->addr, sock_buf),
|
||||||
CAPWAP_VERSION);
|
(preamble & 0xf0) >> 4, CAPWAP_VERSION);
|
||||||
errno = EAGAIN;
|
errno = EAGAIN;
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
@ -593,7 +673,7 @@ int conn_process_packet2(struct conn *conn, uint8_t * packet, int len,
|
|||||||
/* Encrypted data, this shuold never happen here */
|
/* Encrypted data, this shuold never happen here */
|
||||||
cw_dbg(DBG_PKT_ERR,
|
cw_dbg(DBG_PKT_ERR,
|
||||||
"Discarding packet from %s, encrypted data after decryption ...",
|
"Discarding packet from %s, encrypted data after decryption ...",
|
||||||
sock_addr2str(&conn->addr,sock_buf));
|
sock_addr2str(&conn->addr, sock_buf));
|
||||||
errno = EAGAIN;
|
errno = EAGAIN;
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
@ -607,7 +687,7 @@ int conn_process_packet2(struct conn *conn, uint8_t * packet, int len,
|
|||||||
/* Eleminate messages with wrong header size */
|
/* Eleminate messages with wrong header size */
|
||||||
cw_dbg(DBG_PKT_ERR,
|
cw_dbg(DBG_PKT_ERR,
|
||||||
"Discarding packet from %s, header length (%d) greater than packet len (%d).",
|
"Discarding packet from %s, header length (%d) greater than packet len (%d).",
|
||||||
sock_addr2str(&conn->addr,sock_buf), offs, len);
|
sock_addr2str(&conn->addr, sock_buf), offs, len);
|
||||||
errno = EAGAIN;
|
errno = EAGAIN;
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
@ -619,7 +699,8 @@ int conn_process_packet2(struct conn *conn, uint8_t * packet, int len,
|
|||||||
/* wrong rmac size */
|
/* wrong rmac size */
|
||||||
cw_dbg(DBG_PKT_ERR,
|
cw_dbg(DBG_PKT_ERR,
|
||||||
"Discarding packet from %s, wrong R-MAC size, size=%d",
|
"Discarding packet from %s, wrong R-MAC size, size=%d",
|
||||||
sock_addr2str(&conn->addr,sock_buf), *(packet + 8));
|
sock_addr2str(&conn->addr, sock_buf),
|
||||||
|
*(packet + 8));
|
||||||
errno = EAGAIN;
|
errno = EAGAIN;
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
@ -655,23 +736,25 @@ int conn_process_packet2(struct conn *conn, uint8_t * packet, int len,
|
|||||||
return conn->process_message(conn, packet, len, from);
|
return conn->process_message(conn, packet, len, from);
|
||||||
}
|
}
|
||||||
|
|
||||||
int conn_process_packet(struct conn *conn, uint8_t * packet, int len,
|
int conn_process_packet(struct cw_Conn *conn, uint8_t * packet, int len,
|
||||||
struct sockaddr *from){
|
struct sockaddr *from)
|
||||||
|
{
|
||||||
|
|
||||||
/* show this packet in debug output */
|
/* show this packet in debug output */
|
||||||
cw_dbg_pkt(DBG_PKT_IN, conn, packet, len, from);
|
cw_dbg_pkt(DBG_PKT_IN, conn, packet, len, from);
|
||||||
|
|
||||||
return conn_process_packet2(conn,packet,len,from);
|
return conn_process_packet2(conn, packet, len, from);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
int conn_process_data_packet(struct conn *conn, uint8_t * packet, int len,
|
int conn_process_data_packet(struct cw_Conn *conn, uint8_t * packet, int len,
|
||||||
struct sockaddr *from){
|
struct sockaddr *from)
|
||||||
|
{
|
||||||
|
|
||||||
/* show this packet in debug output */
|
/* show this packet in debug output */
|
||||||
cw_dbg_pkt(DBG_PKT_IN, conn, packet, len, from);
|
cw_dbg_pkt(DBG_PKT_IN, conn, packet, len, from);
|
||||||
|
|
||||||
return conn_process_packet2(conn,packet,len,from);
|
return conn_process_packet2(conn, packet, len, from);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
@ -689,7 +772,7 @@ int conn_process_data_packet(struct conn *conn, uint8_t * packet, int len,
|
|||||||
/**
|
/**
|
||||||
* Used as main message loop
|
* Used as main message loop
|
||||||
*/
|
*/
|
||||||
int cw_read_messages(struct conn *conn)
|
int cw_read_messages(struct cw_Conn *conn)
|
||||||
{
|
{
|
||||||
uint8_t buf[2024];
|
uint8_t buf[2024];
|
||||||
int len = 2024;
|
int len = 2024;
|
||||||
@ -706,3 +789,35 @@ int cw_read_messages(struct conn *conn)
|
|||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Destroy a conn object
|
||||||
|
* @param object to destroy
|
||||||
|
*/
|
||||||
|
void conn_destroy(struct cw_Conn * conn)
|
||||||
|
{
|
||||||
|
dtls_shutdown(conn);
|
||||||
|
if (conn->fragman)
|
||||||
|
fragman_destroy(conn->fragman);
|
||||||
|
if (conn->q)
|
||||||
|
free (conn->q);
|
||||||
|
|
||||||
|
if (conn->msg_callbacks)
|
||||||
|
mavl_destroy(conn->msg_callbacks);
|
||||||
|
|
||||||
|
if (conn->base_rmac)
|
||||||
|
free(conn->base_rmac);
|
||||||
|
|
||||||
|
if (conn->remote_cfg)
|
||||||
|
cw_cfg_destroy(conn->remote_cfg);
|
||||||
|
|
||||||
|
if (conn->local_cfg)
|
||||||
|
cw_cfg_destroy(conn->local_cfg);
|
||||||
|
|
||||||
|
if (conn->update_cfg)
|
||||||
|
cw_cfg_destroy(conn->update_cfg);
|
||||||
|
free(conn);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
175
src/cw/conn.h
175
src/cw/conn.h
@ -30,7 +30,7 @@
|
|||||||
#include <sys/socket.h>
|
#include <sys/socket.h>
|
||||||
|
|
||||||
#include "fragman.h"
|
#include "fragman.h"
|
||||||
#include "cwmsg.h"
|
//#include "cwmsg.h"
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
@ -38,7 +38,6 @@
|
|||||||
|
|
||||||
/*#include "mbag.h"*/
|
/*#include "mbag.h"*/
|
||||||
|
|
||||||
#include "intavltree.h"
|
|
||||||
#include "bstr.h"
|
#include "bstr.h"
|
||||||
#include "msgset.h"
|
#include "msgset.h"
|
||||||
|
|
||||||
@ -56,7 +55,7 @@ struct cw_action_in;
|
|||||||
/**
|
/**
|
||||||
* Connection Object
|
* Connection Object
|
||||||
*/
|
*/
|
||||||
struct conn {
|
struct cw_Conn {
|
||||||
int sock;
|
int sock;
|
||||||
struct sockaddr_storage addr;
|
struct sockaddr_storage addr;
|
||||||
|
|
||||||
@ -72,27 +71,22 @@ struct conn {
|
|||||||
int recv_timeout;
|
int recv_timeout;
|
||||||
|
|
||||||
|
|
||||||
mavl_t remote_cfg;
|
cw_Cfg_t * global_cfg; /**< This should set the global cfg of the program
|
||||||
mavl_t default_cfg;
|
which is using this conn object.
|
||||||
|
Teh global_cfg has to be treated read-only. */
|
||||||
|
|
||||||
|
cw_Cfg_t * local_cfg; /**< local_cfg contains overrides for global_cfg
|
||||||
|
wich are related to this conn object. */
|
||||||
|
|
||||||
|
mavl_t remote_cfg; /**< contains the configuration we now from the
|
||||||
|
device this conn object ist connected to.
|
||||||
|
Typically this is what we have got from discovery
|
||||||
|
response or join response in WTP mode.
|
||||||
|
And in AC mode this contains date receive from
|
||||||
|
configuration status request. */
|
||||||
|
|
||||||
mavl_t update_cfg;
|
mavl_t update_cfg;
|
||||||
mavl_t local_cfg;
|
|
||||||
mavl_t global_cfg;
|
|
||||||
|
|
||||||
int (*write_header)(struct cw_ElemHandler * handler, uint8_t * dst, int len);
|
|
||||||
int (*header_len)(struct cw_ElemHandler *handler);
|
|
||||||
|
|
||||||
/* mbag_t outgoing;
|
|
||||||
mbag_t incomming;
|
|
||||||
mbag_t remote;
|
|
||||||
mbag_t local;
|
|
||||||
|
|
||||||
mbag_t radios;
|
|
||||||
mbag_t radios_upd;
|
|
||||||
mbag_t config;
|
|
||||||
mbag_t config_upd;
|
|
||||||
*/
|
|
||||||
|
|
||||||
/* uint8_t session_id[16];*/
|
|
||||||
bstr16_t session_id;
|
bstr16_t session_id;
|
||||||
|
|
||||||
|
|
||||||
@ -105,16 +99,12 @@ struct conn {
|
|||||||
uint8_t wbid;
|
uint8_t wbid;
|
||||||
|
|
||||||
|
|
||||||
/** Counter for mandatory message elements */
|
|
||||||
struct avltree *mand;
|
|
||||||
|
|
||||||
|
|
||||||
/** Actionsdefs - this defines the possible actions for
|
/** Actionsdefs - this defines the possible actions for
|
||||||
this conn object, so in the end this is the specification
|
this conn object, so in the end this is the specification
|
||||||
of the protocoll */
|
of the protocoll */
|
||||||
|
|
||||||
|
|
||||||
struct cw_MsgSet * msgset;
|
|
||||||
|
|
||||||
|
|
||||||
uint8_t capwap_prevstate;
|
uint8_t capwap_prevstate;
|
||||||
@ -135,10 +125,6 @@ struct conn {
|
|||||||
int last_seqnum_received;
|
int last_seqnum_received;
|
||||||
int last_message_id_received;
|
int last_message_id_received;
|
||||||
|
|
||||||
|
|
||||||
struct cwmsg req_msg;
|
|
||||||
struct cwmsg resp_msg;
|
|
||||||
|
|
||||||
/** Buffer for outgoing request messages */
|
/** Buffer for outgoing request messages */
|
||||||
uint8_t req_buffer[CONN_MAX_MSG_LENGTH];
|
uint8_t req_buffer[CONN_MAX_MSG_LENGTH];
|
||||||
|
|
||||||
@ -154,20 +140,13 @@ struct conn {
|
|||||||
|
|
||||||
/* receive and send methods */
|
/* receive and send methods */
|
||||||
|
|
||||||
int (*recv_packet) (struct conn *, uint8_t *, int);
|
int (*recv_packet) (struct cw_Conn*, uint8_t *, int);
|
||||||
int (*recv_packet_peek) (struct conn *, uint8_t *, int);
|
int (*recv_packet_peek) (struct cw_Conn*, uint8_t *, int);
|
||||||
int (*send_packet) (struct conn *, const uint8_t *, int);
|
int (*send_packet) (struct cw_Conn*, const uint8_t *, int);
|
||||||
/*
|
int (*readfrom) (struct cw_Conn*, uint8_t *, int, struct sockaddr_storage *);
|
||||||
// int (*recv_data_packet) (struct conn *, uint8_t *,int);
|
int (*read) (struct cw_Conn*, uint8_t *, int);
|
||||||
// int (*send_data_packet) (struct conn *, const uint8_t *, int);
|
int (*write) (struct cw_Conn*, const uint8_t *, int);
|
||||||
*/
|
|
||||||
|
|
||||||
int (*readfrom) (struct conn *, uint8_t *, int, struct sockaddr_storage *);
|
|
||||||
int (*read) (struct conn *, uint8_t *, int);
|
|
||||||
int (*write) (struct conn *, const uint8_t *, int);
|
|
||||||
/*
|
|
||||||
// int (*write_data) (struct conn *, const uint8_t *, int);
|
|
||||||
*/
|
|
||||||
/* optional packet queue */
|
/* optional packet queue */
|
||||||
uint8_t **q;
|
uint8_t **q;
|
||||||
int qsize;
|
int qsize;
|
||||||
@ -179,23 +158,23 @@ struct conn {
|
|||||||
int cur_packet_pos;
|
int cur_packet_pos;
|
||||||
|
|
||||||
/* dtls stuff */
|
/* dtls stuff */
|
||||||
int (*dtls_start) (struct conn *);
|
int (*dtls_start) (struct cw_Conn*);
|
||||||
int (*dtls_accept) (struct conn *);
|
int (*dtls_accept) (struct cw_Conn*);
|
||||||
|
|
||||||
bstr16_t dtls_psk;
|
bstr16_t dtls_psk;
|
||||||
int dtls_psk_enable;
|
int dtls_psk_enable;
|
||||||
|
|
||||||
int dtls_dhbits;
|
int dtls_dhbits;
|
||||||
int (*dtls_get_psk)(struct conn *,const char *user,uint8_t**psk, int *len);
|
int (*dtls_get_psk)(struct cw_Conn*,const char *user,uint8_t**psk, int *len);
|
||||||
|
|
||||||
struct cw_Mod *cmod, *bmod;
|
struct cw_Mod *cmod, *bmod;
|
||||||
|
|
||||||
char *dtls_cert_file;
|
const char *dtls_cert_file;
|
||||||
char *dtls_key_file;
|
const char *dtls_key_file;
|
||||||
char *dtls_key_pass;
|
const char *dtls_key_pass;
|
||||||
|
|
||||||
void *dtls_data;
|
void *dtls_data;
|
||||||
char *dtls_cipher;
|
const char *dtls_cipher;
|
||||||
int dtls_error;
|
int dtls_error;
|
||||||
|
|
||||||
uint8_t dtls_cookie[8];
|
uint8_t dtls_cookie[8];
|
||||||
@ -219,7 +198,7 @@ struct conn {
|
|||||||
void *data;
|
void *data;
|
||||||
|
|
||||||
/** Mode */
|
/** Mode */
|
||||||
int capwap_mode;
|
// int capwap_mode;
|
||||||
|
|
||||||
/** CAWAP mode for outgoing messages */
|
/** CAWAP mode for outgoing messages */
|
||||||
int capwap_mode_out;
|
int capwap_mode_out;
|
||||||
@ -229,25 +208,27 @@ struct conn {
|
|||||||
int strict_hdr;
|
int strict_hdr;
|
||||||
|
|
||||||
|
|
||||||
int (*process_packet)(struct conn *conn, uint8_t * packet, int len,struct sockaddr *from);
|
int (*process_packet)(struct cw_Conn*conn, uint8_t * packet, int len,struct sockaddr *from);
|
||||||
int (*process_message)(struct conn *conn, uint8_t * rawmsg, int rawlen,
|
int (*process_message)(struct cw_Conn*conn, uint8_t * rawmsg, int rawlen,
|
||||||
struct sockaddr *from);
|
struct sockaddr *from);
|
||||||
|
|
||||||
|
|
||||||
int detected;
|
int detected;
|
||||||
void * mods;
|
struct cw_MsgSet * msgset;
|
||||||
|
void (*setup_complete)(struct cw_Conn *conn);
|
||||||
|
|
||||||
|
struct mavl * msg_callbacks;
|
||||||
|
|
||||||
int (*msg_start)(struct conn *conn,struct cw_action_in *a,uint8_t*data,int len,struct sockaddr *from);
|
|
||||||
int (*msg_end)(struct conn *conn,struct cw_action_in *a,uint8_t*elem,int len,struct sockaddr *from);
|
|
||||||
|
|
||||||
int (*elem_end)(struct conn *conn,struct cw_action_in *a,int afrc,uint8_t*elem,int len,struct sockaddr *from);
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
// void (*actions_registered)(struct conn *conn);
|
int (*msg_start)(struct cw_Conn*conn,struct cw_action_in *a,uint8_t*data,int len,struct sockaddr *from);
|
||||||
*/
|
int (*msg_end)(struct cw_Conn*conn,struct cw_action_in *a,uint8_t*elem,int len,struct sockaddr *from);
|
||||||
|
|
||||||
|
int (*elem_end)(struct cw_Conn*conn,struct cw_action_in *a,int afrc,uint8_t*elem,int len,struct sockaddr *from);
|
||||||
|
*/
|
||||||
|
|
||||||
};
|
};
|
||||||
|
typedef struct cw_Conn cw_Conn_t;
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
@ -255,76 +236,86 @@ struct conn {
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
struct conn *conn_create(int sock, struct sockaddr *addr, int qsize);
|
struct cw_Conn* cw_conn_create(int sock, struct sockaddr *addr, int qsize);
|
||||||
struct conn *conn_create_noq(int sock, struct sockaddr *addr);
|
struct cw_Conn* conn_create_noq(int sock, struct sockaddr *addr);
|
||||||
|
|
||||||
|
|
||||||
extern int conn_send_cwmsg(struct conn *conn, struct cwmsg *cwmsg);
|
//extern int conn_send_cwmsg(struct cw_Conn*conn, struct cwmsg *cwmsg);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
//extern int conn_process_packet(struct conn *conn, uint8_t * packet, int len,
|
//extern int conn_process_packet(struct cw_Conn*conn, uint8_t * packet, int len,
|
||||||
// int (*cb) (void *, uint8_t *,int len), void *cbarg);
|
// int (*cb) (void *, uint8_t *,int len), void *cbarg);
|
||||||
*/
|
*/
|
||||||
|
|
||||||
extern int conn_process_packet(struct conn *conn, uint8_t * packet, int len,struct sockaddr *from);
|
extern int conn_process_packet(struct cw_Conn*conn, uint8_t * packet, int len,struct sockaddr *from);
|
||||||
extern int process_message(struct conn *conn, uint8_t * rawmsg, int rawlen,
|
extern int process_message(struct cw_Conn*conn, uint8_t * rawmsg, int rawlen,
|
||||||
struct sockaddr *from);
|
struct sockaddr *from);
|
||||||
|
|
||||||
extern uint8_t *conn_get_message(struct conn *conn);
|
extern uint8_t *conn_get_message(struct cw_Conn*conn);
|
||||||
|
|
||||||
extern int conn_send_packet(struct conn *conn, const uint8_t * buffer, int len);
|
extern int conn_send_packet(struct cw_Conn*conn, const uint8_t * buffer, int len);
|
||||||
extern int conn_send_data_packet(struct conn * conn, const uint8_t * buffer, int len);
|
extern int conn_send_data_packet(struct cw_Conn* conn, const uint8_t * buffer, int len);
|
||||||
|
|
||||||
extern void conn_destroy(struct conn *conn);
|
extern void conn_destroy(struct cw_Conn*conn);
|
||||||
|
|
||||||
uint8_t *conn_q_get_packet(struct conn *conn);
|
uint8_t *conn_q_get_packet(struct cw_Conn*conn);
|
||||||
extern int conn_q_recv_packet(struct conn *conn, uint8_t * buffer, int len);
|
extern int conn_q_recv_packet(struct cw_Conn*conn, uint8_t * buffer, int len);
|
||||||
extern int conn_q_recv_packet_peek(struct conn *conn, uint8_t * buffer, int len);
|
extern int conn_q_recv_packet_peek(struct cw_Conn*conn, uint8_t * buffer, int len);
|
||||||
|
|
||||||
extern int conn_recv_packet(struct conn *conn, uint8_t * buf, int len);
|
extern int conn_recv_packet(struct cw_Conn*conn, uint8_t * buf, int len);
|
||||||
extern int conn_recv_packet_peek(struct conn *conn, uint8_t * buf, int len);
|
extern int conn_recv_packet_peek(struct cw_Conn*conn, uint8_t * buf, int len);
|
||||||
|
|
||||||
extern int conn_send_response(struct conn *conn, struct cwmsg *cwmsg, int seqnum);
|
//extern int conn_send_response(struct cw_Conn*conn, struct cwmsg *cwmsg, int seqnum);
|
||||||
extern struct cwrmsg *conn_get_response(struct conn *conn);
|
extern struct cwrmsg *conn_get_response(struct cw_Conn*conn);
|
||||||
|
|
||||||
|
|
||||||
#define conn_get_next_seqnum(conn) (conn->seqnum=((conn->seqnum+1)&0xff))
|
#define conn_get_next_seqnum(conn) (conn->seqnum=((conn->seqnum+1)&0xff))
|
||||||
#define conn_get_last_seqnum(conn) (conn->seqnum&0xff)
|
#define conn_get_last_seqnum(conn) (conn->seqnum&0xff)
|
||||||
|
|
||||||
|
|
||||||
void conn_q_add_packet(struct conn *conn, uint8_t * packet, int len);
|
void conn_q_add_packet(struct cw_Conn*conn, uint8_t * packet, int len);
|
||||||
|
|
||||||
struct image_identifier;
|
struct image_identifier;
|
||||||
struct cwimage_data;
|
struct cwimage_data;
|
||||||
|
|
||||||
extern void conn_prepare_request(struct conn *conn, int type);
|
extern void conn_prepare_request(struct cw_Conn*conn, int type);
|
||||||
extern int conn_prepare_image_data_request(struct conn *conn, struct cwimage_data *,
|
extern int conn_prepare_image_data_request(struct cw_Conn*conn, struct cwimage_data *,
|
||||||
struct image_identifier *id);
|
struct image_identifier *id);
|
||||||
/*
|
/*
|
||||||
//extern void conn_detect_capwap(struct conn *conn, struct wtpinfo *wtpinfo);
|
//extern void conn_detect_capwap(struct cw_Conn*conn, struct wtpinfo *wtpinfo);
|
||||||
*/
|
*/
|
||||||
|
|
||||||
struct cwrmsg *conn_send_request(struct conn *conn);
|
struct cwrmsg *conn_send_request(struct cw_Conn*conn);
|
||||||
struct cwrmsg *conn_wait_for_message(struct conn *conn, time_t timer);
|
struct cwrmsg *conn_wait_for_message(struct cw_Conn*conn, time_t timer);
|
||||||
|
|
||||||
struct cwrmsg *conn_wait_for_request(struct conn *conn, int *msglist, time_t timer);
|
struct cwrmsg *conn_wait_for_request(struct cw_Conn*conn, int *msglist, time_t timer);
|
||||||
|
|
||||||
int conn_q_wait_packet(struct conn * conn, int seconds);
|
//int conn_q_wait_packet(struct cw_Conn* conn, int seconds);
|
||||||
|
|
||||||
#define conn_is_error(conn) (conn->dtls_error)
|
#define conn_is_error(conn) (conn->dtls_error)
|
||||||
|
|
||||||
void conn_init(struct conn *conn);
|
void cw_conn_init(struct cw_Conn*conn);
|
||||||
|
|
||||||
extern int cw_read_messages(struct conn *conn);
|
extern int cw_read_messages(struct cw_Conn*conn);
|
||||||
|
|
||||||
extern int conn_recvfrom_packet(struct conn *conn, uint8_t * buf, int len,
|
extern int conn_recvfrom_packet(struct cw_Conn*conn, uint8_t * buf, int len,
|
||||||
struct sockaddr_storage *from);
|
struct sockaddr_storage *from);
|
||||||
|
|
||||||
int conn_send_msg(struct conn * conn, uint8_t *rawmsg);
|
int conn_send_msg(struct cw_Conn* conn, uint8_t *rawmsg);
|
||||||
int cw_read_from(struct conn * conn, struct sockaddr_storage * from);
|
int cw_read_from(struct cw_Conn* conn, struct sockaddr_storage * from);
|
||||||
|
|
||||||
int conn_send_msg(struct conn *conn, uint8_t * rawmsg);
|
int conn_send_msg(struct cw_Conn *conn, uint8_t * rawmsg);
|
||||||
|
|
||||||
|
void conn_clear_upd(struct cw_Conn*conn, int merge);
|
||||||
|
|
||||||
|
|
||||||
|
int cw_conn_set_msg_cb(struct cw_Conn *conn, int type, cw_MsgCallbackFun fun);
|
||||||
|
cw_MsgCallbackFun cw_conn_get_msg_cb(struct cw_Conn *conn, int type);
|
||||||
|
|
||||||
|
int cw_decode_element(struct cw_ElemHandlerParams *params, int proto,
|
||||||
|
int vendor, int elem_id, uint8_t * data, int len);
|
||||||
|
|
||||||
|
int cw_decode_elements(struct cw_ElemHandlerParams * params, uint8_t * elems_ptr, int elems_len);
|
||||||
|
|
||||||
void conn_clear_upd(struct conn *conn, int merge);
|
|
||||||
|
|
||||||
#endif /* __CONN_H */
|
#endif /* __CONN_H */
|
||||||
|
@ -35,76 +35,4 @@
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Create a conn object
|
|
||||||
* @param sock a socket
|
|
||||||
* @param addr the address associated
|
|
||||||
* @param qsize size of packet queue
|
|
||||||
* @return A pointer to the created object
|
|
||||||
* This function creates a conn obnject with queueing functionality
|
|
||||||
* for asynchronous operation.
|
|
||||||
* To create a conn object without queue functionallity use #conn_create_noq.
|
|
||||||
*/
|
|
||||||
struct conn * conn_create(int sock, struct sockaddr * addr, int qsize)
|
|
||||||
{
|
|
||||||
struct conn * conn;
|
|
||||||
conn = malloc(sizeof (struct conn));
|
|
||||||
if (!conn)
|
|
||||||
return NULL;
|
|
||||||
|
|
||||||
conn_init(conn);
|
|
||||||
|
|
||||||
conn->sock=sock;
|
|
||||||
|
|
||||||
if (addr)
|
|
||||||
sock_copyaddr(&conn->addr,addr);
|
|
||||||
|
|
||||||
|
|
||||||
conn->fragman = fragman_create();
|
|
||||||
if (conn->fragman==NULL){
|
|
||||||
conn_destroy(conn);
|
|
||||||
return NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
conn->qsize=qsize;
|
|
||||||
if (qsize != 0){
|
|
||||||
if (!(conn->q=malloc( sizeof(uint8_t *) * qsize))){
|
|
||||||
conn_destroy(conn);
|
|
||||||
return NULL;
|
|
||||||
}
|
|
||||||
conn->qrpos=-1;
|
|
||||||
if (sem_init(&conn->q_sem,0,0)!=0){
|
|
||||||
cw_log(LOG_ERR,"Fatal- Can't init semaphore for conn object: %s",strerror(errno));
|
|
||||||
conn_destroy(conn);
|
|
||||||
return NULL;
|
|
||||||
};
|
|
||||||
conn->recv_packet=conn_q_recv_packet;
|
|
||||||
conn->recv_packet_peek=conn_q_recv_packet_peek;
|
|
||||||
}
|
|
||||||
else{
|
|
||||||
conn->recv_packet = conn_recv_packet;
|
|
||||||
conn->recv_packet_peek = conn_recv_packet_peek;
|
|
||||||
}
|
|
||||||
|
|
||||||
conn->send_packet = conn_send_packet;
|
|
||||||
/* conn->send_data_packet = conn_send_data_packet;*/
|
|
||||||
|
|
||||||
conn->last_seqnum_received=-1;
|
|
||||||
conn->mtu=600;
|
|
||||||
|
|
||||||
|
|
||||||
conn->cur_packet=0;
|
|
||||||
conn->recv_timeout=1;
|
|
||||||
|
|
||||||
conn->seqnum=-1;
|
|
||||||
conn->write = conn->send_packet;
|
|
||||||
conn->read = conn->recv_packet;
|
|
||||||
|
|
||||||
/* conn->write_data = conn->send_data_packet; */
|
|
||||||
|
|
||||||
conn->dtls_mtu = 600;
|
|
||||||
|
|
||||||
return conn;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
@ -36,14 +36,14 @@
|
|||||||
* @retval 1 Success
|
* @retval 1 Success
|
||||||
* @retval 0 failure, conslt errno for more details
|
* @retval 0 failure, conslt errno for more details
|
||||||
*/
|
*/
|
||||||
struct conn * conn_create_noq(int sock, struct sockaddr * addr)
|
struct cw_Conn * conn_create_noq(int sock, struct sockaddr * addr)
|
||||||
{
|
{
|
||||||
struct conn * conn;
|
struct cw_Conn * conn;
|
||||||
conn = malloc(sizeof (struct conn));
|
conn = malloc(sizeof (struct cw_Conn ));
|
||||||
if (!conn)
|
if (!conn)
|
||||||
return NULL;
|
return NULL;
|
||||||
|
|
||||||
conn_init(conn);
|
cw_conn_init(conn);
|
||||||
|
|
||||||
|
|
||||||
conn->sock=sock;
|
conn->sock=sock;
|
||||||
|
@ -1,41 +0,0 @@
|
|||||||
/*
|
|
||||||
This file is part of actube.
|
|
||||||
|
|
||||||
actube is free software: you can redistribute it and/or modify
|
|
||||||
it under the terms of the GNU General Public License as published by
|
|
||||||
the Free Software Foundation, either version 3 of the License, or
|
|
||||||
(at your option) any later version.
|
|
||||||
|
|
||||||
libcapwap is distributed in the hope that it will be useful,
|
|
||||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
||||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
||||||
GNU General Public License for more details.
|
|
||||||
|
|
||||||
You should have received a copy of the GNU General Public License
|
|
||||||
along with Foobar. If not, see <http://www.gnu.org/licenses/>.
|
|
||||||
*/
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @file
|
|
||||||
* @brief Implements conn_destroy
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include <stdlib.h>
|
|
||||||
|
|
||||||
#include "conn.h"
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Destroy a conn object
|
|
||||||
* @param object to destroy
|
|
||||||
*/
|
|
||||||
void conn_destroy(struct conn * conn)
|
|
||||||
{
|
|
||||||
if (conn->fragman)
|
|
||||||
fragman_destroy(conn->fragman);
|
|
||||||
if (conn->q)
|
|
||||||
free (conn->q);
|
|
||||||
|
|
||||||
free(conn);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
@ -1,72 +0,0 @@
|
|||||||
/*
|
|
||||||
This file is part of libcapwap.
|
|
||||||
|
|
||||||
libcapwap is free software: you can redistribute it and/or modify
|
|
||||||
it under the terms of the GNU General Public License as published by
|
|
||||||
the Free Software Foundation, either version 3 of the License, or
|
|
||||||
(at your option) any later version.
|
|
||||||
|
|
||||||
libcapwap is distributed in the hope that it will be useful,
|
|
||||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
||||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
||||||
GNU General Public License for more details.
|
|
||||||
|
|
||||||
You should have received a copy of the GNU General Public License
|
|
||||||
along with Foobar. If not, see <http://www.gnu.org/licenses/>.
|
|
||||||
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @file
|
|
||||||
* @brief conn_init
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include <string.h>
|
|
||||||
|
|
||||||
|
|
||||||
#include "conn.h"
|
|
||||||
#include "capwap.h"
|
|
||||||
#include "cw.h"
|
|
||||||
|
|
||||||
static int write_header(struct cw_ElemHandler * handler, uint8_t * dst, int len)
|
|
||||||
{
|
|
||||||
if (handler->vendor)
|
|
||||||
return len + cw_put_elem_vendor_hdr(dst, handler->vendor, handler->id, len);
|
|
||||||
|
|
||||||
return len + cw_put_elem_hdr(dst, handler->id, len);
|
|
||||||
}
|
|
||||||
|
|
||||||
static int header_len(struct cw_ElemHandler * handler)
|
|
||||||
{
|
|
||||||
return handler->vendor ? 10 : 4;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Basic initialization of a conn object
|
|
||||||
* @param conn conn object to initialize
|
|
||||||
*/
|
|
||||||
void conn_init(struct conn * conn)
|
|
||||||
{
|
|
||||||
memset(conn,0,sizeof(struct conn));
|
|
||||||
conn->retransmit_interval=CAPWAP_RETRANSMIT_INTERVAL;
|
|
||||||
conn->max_retransmit=CAPWAP_MAX_RETRANSMIT;
|
|
||||||
conn->wait_dtls=CAPWAP_WAIT_DTLS;
|
|
||||||
conn->wait_join=CAPWAP_WAIT_JOIN;
|
|
||||||
conn->mtu_discovery=1;
|
|
||||||
conn->capwap_mode = 0;
|
|
||||||
conn->strict_capwap=1;
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
conn->process_packet=conn_process_packet;
|
|
||||||
conn->process_message=process_message;
|
|
||||||
|
|
||||||
conn->write_header = write_header;
|
|
||||||
conn->header_len = header_len;
|
|
||||||
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
@ -25,7 +25,7 @@
|
|||||||
#include "sock.h"
|
#include "sock.h"
|
||||||
|
|
||||||
|
|
||||||
void conn_q_add_packet(struct conn * conn,uint8_t *packet,int len)
|
void conn_q_add_packet(struct cw_Conn * conn,uint8_t *packet,int len)
|
||||||
{
|
{
|
||||||
char sock_buf[SOCK_ADDR_BUFSIZE];
|
char sock_buf[SOCK_ADDR_BUFSIZE];
|
||||||
int qwpos = conn->qwpos;
|
int qwpos = conn->qwpos;
|
||||||
|
@ -19,7 +19,7 @@
|
|||||||
#include <time.h>
|
#include <time.h>
|
||||||
#include "conn.h"
|
#include "conn.h"
|
||||||
|
|
||||||
uint8_t * conn_q_get_packet(struct conn * conn)
|
uint8_t * conn_q_get_packet(struct cw_Conn * conn)
|
||||||
{
|
{
|
||||||
int qrpos;
|
int qrpos;
|
||||||
struct timespec timespec;
|
struct timespec timespec;
|
||||||
|
@ -22,7 +22,7 @@
|
|||||||
|
|
||||||
#include "conn.h"
|
#include "conn.h"
|
||||||
|
|
||||||
static int conn_q_recv_packet_(struct conn * conn, uint8_t * buffer,int len,int peek)
|
static int conn_q_recv_packet_(struct cw_Conn * conn, uint8_t * buffer,int len,int peek)
|
||||||
{
|
{
|
||||||
if ( !conn->cur_packet)
|
if ( !conn->cur_packet)
|
||||||
{
|
{
|
||||||
@ -58,12 +58,12 @@ static int conn_q_recv_packet_(struct conn * conn, uint8_t * buffer,int len,int
|
|||||||
return conn->cur_packet_len;
|
return conn->cur_packet_len;
|
||||||
}
|
}
|
||||||
|
|
||||||
int conn_q_recv_packet(struct conn * conn, uint8_t * buffer,int len)
|
int conn_q_recv_packet(struct cw_Conn * conn, uint8_t * buffer,int len)
|
||||||
{
|
{
|
||||||
return conn_q_recv_packet_(conn,buffer,len,0);
|
return conn_q_recv_packet_(conn,buffer,len,0);
|
||||||
}
|
}
|
||||||
|
|
||||||
int conn_q_recv_packet_peek(struct conn * conn, uint8_t * buffer,int len)
|
int conn_q_recv_packet_peek(struct cw_Conn * conn, uint8_t * buffer,int len)
|
||||||
{
|
{
|
||||||
return conn_q_recv_packet_(conn,buffer,len,1);
|
return conn_q_recv_packet_(conn,buffer,len,1);
|
||||||
}
|
}
|
||||||
|
@ -3,7 +3,7 @@
|
|||||||
|
|
||||||
#include "conn.h"
|
#include "conn.h"
|
||||||
|
|
||||||
int conn_q_wait_packet(struct conn * conn, int seconds)
|
int conn_q_wait_packet(struct cw_Conn * conn, int seconds)
|
||||||
{
|
{
|
||||||
|
|
||||||
struct timespec timespec;
|
struct timespec timespec;
|
||||||
|
@ -27,7 +27,7 @@
|
|||||||
|
|
||||||
#include "sock.h"
|
#include "sock.h"
|
||||||
|
|
||||||
int conn_recv_packet_(struct conn *conn, uint8_t * buf, int len, int flags)
|
int conn_recv_packet_(struct cw_Conn *conn, uint8_t * buf, int len, int flags)
|
||||||
{
|
{
|
||||||
int n;
|
int n;
|
||||||
while ((n = recv(conn->sock, (char *) buf, len, flags)) < 0) {
|
while ((n = recv(conn->sock, (char *) buf, len, flags)) < 0) {
|
||||||
@ -41,7 +41,7 @@ int conn_recv_packet_(struct conn *conn, uint8_t * buf, int len, int flags)
|
|||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
int conn_recvfrom_packet(struct conn *conn, uint8_t * buf, int len,
|
int conn_recvfrom_packet(struct cw_Conn *conn, uint8_t * buf, int len,
|
||||||
struct sockaddr_storage *from)
|
struct sockaddr_storage *from)
|
||||||
{
|
{
|
||||||
int n;
|
int n;
|
||||||
@ -65,7 +65,7 @@ int conn_recvfrom_packet(struct conn *conn, uint8_t * buf, int len,
|
|||||||
|
|
||||||
#include "log.h"
|
#include "log.h"
|
||||||
|
|
||||||
int conn_recv_packet_x(struct conn *conn, uint8_t * buf, int len, int flags)
|
int conn_recv_packet_x(struct cw_Conn *conn, uint8_t * buf, int len, int flags)
|
||||||
{
|
{
|
||||||
int port;
|
int port;
|
||||||
socklen_t al;
|
socklen_t al;
|
||||||
@ -104,12 +104,12 @@ int conn_recv_packet_x(struct conn *conn, uint8_t * buf, int len, int flags)
|
|||||||
|
|
||||||
/* yes, these functions could be better defined as macros in a .h file */
|
/* yes, these functions could be better defined as macros in a .h file */
|
||||||
|
|
||||||
int conn_recv_packet(struct conn *conn, uint8_t * buf, int len)
|
int conn_recv_packet(struct cw_Conn *conn, uint8_t * buf, int len)
|
||||||
{
|
{
|
||||||
return conn_recv_packet_x(conn, buf, len, 0);
|
return conn_recv_packet_x(conn, buf, len, 0);
|
||||||
}
|
}
|
||||||
|
|
||||||
int conn_recv_packet_peek(struct conn *conn, uint8_t * buf, int len)
|
int conn_recv_packet_peek(struct cw_Conn *conn, uint8_t * buf, int len)
|
||||||
{
|
{
|
||||||
int rc = conn_recv_packet_(conn, buf, len, MSG_PEEK);
|
int rc = conn_recv_packet_(conn, buf, len, MSG_PEEK);
|
||||||
return rc;
|
return rc;
|
||||||
|
@ -29,7 +29,7 @@
|
|||||||
#include "dbg.h"
|
#include "dbg.h"
|
||||||
|
|
||||||
|
|
||||||
int conn_send_data_packet(struct conn * conn, const uint8_t * buffer, int len)
|
int conn_send_data_packet(struct cw_Conn * conn, const uint8_t * buffer, int len)
|
||||||
{
|
{
|
||||||
char sock_buf[SOCK_ADDR_BUFSIZE];
|
char sock_buf[SOCK_ADDR_BUFSIZE];
|
||||||
int n;
|
int n;
|
||||||
|
@ -3,9 +3,9 @@
|
|||||||
#include "dbg.h"
|
#include "dbg.h"
|
||||||
|
|
||||||
#define CW_MODE_ZYXEL 7
|
#define CW_MODE_ZYXEL 7
|
||||||
extern cw_send_msg(struct conn * conn,uint8_t * msg);
|
extern int cw_send_msg(struct cw_Conn * conn,uint8_t * msg);
|
||||||
|
|
||||||
int conn_send_msg(struct conn * conn, uint8_t *rawmsg)
|
int conn_send_msg(struct cw_Conn * conn, uint8_t *rawmsg)
|
||||||
{
|
{
|
||||||
uint8_t * ptr;
|
uint8_t * ptr;
|
||||||
int packetlen;
|
int packetlen;
|
||||||
@ -18,9 +18,9 @@ int conn_send_msg(struct conn * conn, uint8_t *rawmsg)
|
|||||||
|
|
||||||
/* Zyxel doesn't count msg element length from
|
/* Zyxel doesn't count msg element length from
|
||||||
behind seqnum */
|
behind seqnum */
|
||||||
if (conn->capwap_mode == CW_MODE_ZYXEL){
|
// if (conn->capwap_mode == CW_MODE_ZYXEL){
|
||||||
/* // XXX val-=3; */
|
/* // XXX val-=3; */
|
||||||
}
|
// }
|
||||||
|
|
||||||
|
|
||||||
ptr = rawmsg;
|
ptr = rawmsg;
|
||||||
@ -34,7 +34,7 @@ mtu = 9440;
|
|||||||
mtu = mtu >> 3;
|
mtu = mtu >> 3;
|
||||||
mtu = mtu << 3;
|
mtu = mtu << 3;
|
||||||
|
|
||||||
printf("packetlenX = %d (%d)\n",packetlen,hlen);
|
// printf("packetlenX = %d (%d)\n",packetlen,hlen);
|
||||||
int offset = cw_get_hdr_msg_offset(rawmsg);
|
int offset = cw_get_hdr_msg_offset(rawmsg);
|
||||||
return cw_send_msg(conn,rawmsg+offset);
|
return cw_send_msg(conn,rawmsg+offset);
|
||||||
|
|
||||||
|
@ -27,7 +27,7 @@
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
int conn_send_packet(struct conn * conn, const uint8_t * buffer, int len)
|
int conn_send_packet(struct cw_Conn * conn, const uint8_t * buffer, int len)
|
||||||
{
|
{
|
||||||
int n;
|
int n;
|
||||||
while((n=sendto( conn->sock, buffer, len, 0,
|
while((n=sendto( conn->sock, buffer, len, 0,
|
||||||
|
@ -1,64 +0,0 @@
|
|||||||
/*
|
|
||||||
This file is part of libcapwap.
|
|
||||||
|
|
||||||
libcapwap is free software: you can redistribute it and/or modify
|
|
||||||
it under the terms of the GNU General Public License as published by
|
|
||||||
the Free Software Foundation, either version 3 of the License, or
|
|
||||||
(at your option) any later version.
|
|
||||||
|
|
||||||
libcapwap is distributed in the hope that it will be useful,
|
|
||||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
||||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
||||||
GNU General Public License for more details.
|
|
||||||
|
|
||||||
You should have received a copy of the GNU General Public License
|
|
||||||
along with Foobar. If not, see <http://www.gnu.org/licenses/>.
|
|
||||||
|
|
||||||
*/
|
|
||||||
|
|
||||||
/**
|
|
||||||
*@file
|
|
||||||
*@brief conn_send_request
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include "capwap.h"
|
|
||||||
#include "cw_util.h"
|
|
||||||
#include "log.h"
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Send a request message and wait for its response
|
|
||||||
* @param conn the connection
|
|
||||||
*
|
|
||||||
* The message has to be prepared and put to conn->req_msg
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
/*
|
|
||||||
struct cwrmsg * conn_send_request(struct conn * conn)
|
|
||||||
{
|
|
||||||
int i;
|
|
||||||
|
|
||||||
struct cwrmsg * cwrmsg;
|
|
||||||
struct cwmsg * cwmsg = &conn->req_msg;
|
|
||||||
|
|
||||||
|
|
||||||
for (i=0; i<conn->max_retransmit; i++) {
|
|
||||||
|
|
||||||
time_t r_timer = cw_timer_start(conn->retransmit_interval);
|
|
||||||
if (i!=0)
|
|
||||||
cw_dbg(DBG_MSG_ERR,"Retransmitting message, type=%d,seq=%d",cwmsg->type,cwmsg->seqnum);
|
|
||||||
|
|
||||||
conn_send_cwmsg(conn,&conn->req_msg);
|
|
||||||
cwrmsg = conn_wait_for_message(conn,r_timer);
|
|
||||||
if (cwrmsg){
|
|
||||||
if (cwrmsg->type == conn->req_msg.type+1){
|
|
||||||
return cwrmsg;
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
}
|
|
||||||
cw_dbg(DBG_MSG_ERR,"Max retransmit's reached, message type=%d,seq=%d",cwmsg->type,cwmsg->seqnum);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
*/
|
|
@ -39,24 +39,24 @@
|
|||||||
|
|
||||||
static int cmp_by_addr_p ( const void * d1, const void *d2 )
|
static int cmp_by_addr_p ( const void * d1, const void *d2 )
|
||||||
{
|
{
|
||||||
struct conn * c1 = * ( void ** ) d1 ;
|
struct cw_Conn * c1 = * ( void ** ) d1 ;
|
||||||
struct conn * c2 = * ( void ** ) d2 ;
|
struct cw_Conn * c2 = * ( void ** ) d2 ;
|
||||||
return sock_cmpaddr ( ( struct sockaddr* ) &c1->addr, ( struct sockaddr* ) &c2->addr, 1 );
|
return sock_cmpaddr ( ( struct sockaddr* ) &c1->addr, ( struct sockaddr* ) &c2->addr, 1 );
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
static int cmp_by_addr ( const void * d1, const void *d2 )
|
static int cmp_by_addr ( const void * d1, const void *d2 )
|
||||||
{
|
{
|
||||||
struct conn * c1 = * ( void ** ) d1 ;
|
struct cw_Conn * c1 = * ( void ** ) d1 ;
|
||||||
struct conn * c2 = * ( void ** ) d2 ;
|
struct cw_Conn * c2 = * ( void ** ) d2 ;
|
||||||
return sock_cmpaddr ( ( struct sockaddr* ) &c1->addr, ( struct sockaddr* ) &c2->addr, 0 );
|
return sock_cmpaddr ( ( struct sockaddr* ) &c1->addr, ( struct sockaddr* ) &c2->addr, 0 );
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
static int cmp_by_session_id ( const void *d1, const void *d2 )
|
static int cmp_by_session_id ( const void *d1, const void *d2 )
|
||||||
{
|
{
|
||||||
struct conn * c1 = *( void ** ) d1;
|
struct cw_Conn * c1 = *( void ** ) d1;
|
||||||
struct conn * c2 = *( void ** ) d2;
|
struct cw_Conn * c2 = *( void ** ) d2;
|
||||||
int len1,len2;
|
int len1,len2;
|
||||||
|
|
||||||
if (c1->session_id==NULL && c2->session_id==NULL)
|
if (c1->session_id==NULL && c2->session_id==NULL)
|
||||||
@ -133,6 +133,9 @@ void connlist_destroy ( struct connlist * cl )
|
|||||||
|
|
||||||
if ( cl->by_addr )
|
if ( cl->by_addr )
|
||||||
mavl_destroy ( cl->by_addr );
|
mavl_destroy ( cl->by_addr );
|
||||||
|
if ( cl->by_session_id)
|
||||||
|
mavl_destroy ( cl->by_session_id );
|
||||||
|
|
||||||
|
|
||||||
pthread_mutex_destroy ( &cl->connlist_mutex );
|
pthread_mutex_destroy ( &cl->connlist_mutex );
|
||||||
free ( cl );
|
free ( cl );
|
||||||
@ -140,15 +143,15 @@ void connlist_destroy ( struct connlist * cl )
|
|||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
struct conn * connlist_get ( struct connlist * cl, const struct sockaddr * addr )
|
struct cw_Conn * connlist_get ( struct connlist * cl, const struct sockaddr * addr )
|
||||||
{
|
{
|
||||||
struct conn search;
|
struct cw_Conn search;
|
||||||
sock_copyaddr ( &search.addr, addr );
|
sock_copyaddr ( &search.addr, addr );
|
||||||
return mavl_get_ptr ( cl->by_addr, &search );
|
return mavl_get_ptr ( cl->by_addr, &search );
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
struct conn * connlist_add ( struct connlist * cl, struct conn * conn )
|
struct cw_Conn * connlist_add ( struct connlist * cl, struct cw_Conn * conn )
|
||||||
{
|
{
|
||||||
if ( cl->len != 0 )
|
if ( cl->len != 0 )
|
||||||
if ( cl->by_addr->count >= cl->len )
|
if ( cl->by_addr->count >= cl->len )
|
||||||
@ -158,17 +161,17 @@ struct conn * connlist_add ( struct connlist * cl, struct conn * conn )
|
|||||||
return mavl_insert_ptr ( cl->by_addr, conn );
|
return mavl_insert_ptr ( cl->by_addr, conn );
|
||||||
}
|
}
|
||||||
|
|
||||||
struct conn * connlist_get_by_session_id ( struct connlist *cl, struct conn * conn )
|
struct cw_Conn * connlist_get_by_session_id ( struct connlist *cl, struct cw_Conn * conn )
|
||||||
{
|
{
|
||||||
return mavl_get_ptr ( cl->by_session_id, conn );
|
return mavl_get_ptr ( cl->by_session_id, conn );
|
||||||
}
|
}
|
||||||
|
|
||||||
struct conn * connlist_add_by_session_id ( struct connlist * cl, struct conn * conn )
|
struct cw_Conn * connlist_add_by_session_id ( struct connlist * cl, struct cw_Conn * conn )
|
||||||
{
|
{
|
||||||
return mavl_insert_ptr ( cl->by_session_id, conn );
|
return mavl_insert_ptr ( cl->by_session_id, conn );
|
||||||
}
|
}
|
||||||
|
|
||||||
void connlist_remove ( struct connlist *cl, struct conn * conn )
|
void connlist_remove ( struct connlist *cl, struct cw_Conn * conn )
|
||||||
{
|
{
|
||||||
void * md;
|
void * md;
|
||||||
md = conn;
|
md = conn;
|
||||||
|
@ -7,7 +7,7 @@
|
|||||||
#include "pthread.h"
|
#include "pthread.h"
|
||||||
|
|
||||||
struct connlist {
|
struct connlist {
|
||||||
/* struct conn ** connlist; */
|
/* struct cw_Conn ** connlist; */
|
||||||
|
|
||||||
struct mavl *by_addr;
|
struct mavl *by_addr;
|
||||||
struct mavl *by_session_id;
|
struct mavl *by_session_id;
|
||||||
@ -22,12 +22,12 @@ struct connlist *connlist_create(int len, int cmpports);
|
|||||||
void connlist_lock(struct connlist *cl);
|
void connlist_lock(struct connlist *cl);
|
||||||
void connlist_unlock(struct connlist *cl);
|
void connlist_unlock(struct connlist *cl);
|
||||||
void conlist_destroy(struct connlist *cl);
|
void conlist_destroy(struct connlist *cl);
|
||||||
struct conn *connlist_get(struct connlist *cl, const struct sockaddr *addr);
|
struct cw_Conn *connlist_get(struct connlist *cl, const struct sockaddr *addr);
|
||||||
struct conn *connlist_add(struct connlist *cl, struct conn *conn);
|
struct cw_Conn *connlist_add(struct connlist *cl, struct cw_Conn *conn);
|
||||||
void connlist_remove(struct connlist *cl, struct conn *conn);
|
void connlist_remove(struct connlist *cl, struct cw_Conn *conn);
|
||||||
void connlist_destroy(struct connlist *cl);
|
void connlist_destroy(struct connlist *cl);
|
||||||
|
|
||||||
struct conn * connlist_get_by_session_id(struct connlist *cl, struct conn * conn);
|
struct cw_Conn * connlist_get_by_session_id(struct connlist *cl, struct cw_Conn * conn);
|
||||||
struct conn * connlist_add_by_session_id(struct connlist * cl, struct conn * conn);
|
struct cw_Conn * connlist_add_by_session_id(struct connlist * cl, struct cw_Conn * conn);
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
158
src/cw/cw.c
Normal file
158
src/cw/cw.c
Normal file
@ -0,0 +1,158 @@
|
|||||||
|
#include "cw.h"
|
||||||
|
#include "log.h"
|
||||||
|
#include "dbg.h"
|
||||||
|
|
||||||
|
int cw_in_generic(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params,
|
||||||
|
uint8_t * elem_data, int elem_len)
|
||||||
|
{
|
||||||
|
cw_Type_t * type;
|
||||||
|
type = (cw_Type_t*)handler->type;
|
||||||
|
char mkey[CW_CFG_MAX_KEY_LEN];
|
||||||
|
const char *key;
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
if (!type){
|
||||||
|
cw_log(LOG_ERR,"Can't handle element: %s, no type defined",handler->name);
|
||||||
|
return CAPWAP_RESULT_UNRECOGNIZED_MESSAGE_ELEMENT;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (handler->mkkey != NULL){
|
||||||
|
handler->mkkey(handler->key,elem_data,elem_len, mkey);
|
||||||
|
key = mkey;
|
||||||
|
}
|
||||||
|
else{
|
||||||
|
key = handler->key;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/* cw_dbg(DBG_X, "READ: %s / %s",type->name,key);*/
|
||||||
|
type->read(params->cfg, key,elem_data,elem_len,handler->param);
|
||||||
|
return CAPWAP_RESULT_SUCCESS;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
int cw_out_generic(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params
|
||||||
|
, uint8_t * dst)
|
||||||
|
{
|
||||||
|
|
||||||
|
int start, len, l;
|
||||||
|
|
||||||
|
// cw_dbg(DBG_X,"cw_out_generic (%s)%s",((struct cw_Type*)handler->type)->name,handler->key);
|
||||||
|
|
||||||
|
// cw_dbg(DBG_X,"Generic out!!!!!!!!!!!!!!!!!!!!!!!!!!!!");
|
||||||
|
// cw_cfg_dump(params->cfg);
|
||||||
|
// cw_dbg(DBG_X,"Generic out!!!!!!!!!!!!!!!!!!!!!!!!!!!! ENDDUMP");
|
||||||
|
|
||||||
|
start = params->msgset->header_len(handler);
|
||||||
|
len = ((const cw_Type_t*)(handler->type))->
|
||||||
|
write(params->cfg_list,handler->key,dst+start,handler->param);
|
||||||
|
// cw_dbg(DBG_X, "Type result is %d",len);
|
||||||
|
|
||||||
|
if (len == -1) {
|
||||||
|
const char *vendor="";
|
||||||
|
if ( handler->vendor ) {
|
||||||
|
vendor=cw_strvendor(handler->vendor);
|
||||||
|
}
|
||||||
|
if ( params->elemdata->mand) {
|
||||||
|
cw_log(LOG_ERR,
|
||||||
|
"Can't put mandatory element %s %d-(%s) into %s. No value for '%s' found.",
|
||||||
|
vendor, handler->id, handler->name, params->msgdata->name
|
||||||
|
, handler->key
|
||||||
|
);
|
||||||
|
}
|
||||||
|
else{
|
||||||
|
/* cw_dbg(DBG_WARN,"No output for element %s%d -(%s) in %s. Item %s not found.",
|
||||||
|
vendor,
|
||||||
|
a->elem_id, cw_strelemp(conn->actions, a->elem_id)
|
||||||
|
, cw_strmsg(a->msg_id),a->item_id);
|
||||||
|
*/
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
l = params->msgset->write_header(handler,dst,len);
|
||||||
|
|
||||||
|
return l;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
int cw_in_radio_generic(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params,
|
||||||
|
uint8_t * elem_data, int elem_len)
|
||||||
|
{
|
||||||
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
|
int radio;
|
||||||
|
struct cw_Type *type;
|
||||||
|
type = (struct cw_Type*)handler->type;
|
||||||
|
|
||||||
|
if (!type){
|
||||||
|
cw_log(LOG_ERR,"Can't handle element: %s, no type defined",handler->name);
|
||||||
|
return CAPWAP_RESULT_UNRECOGNIZED_MESSAGE_ELEMENT;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
radio=cw_get_byte(elem_data);
|
||||||
|
sprintf(key,"radio.%d/%s",radio,handler->key);
|
||||||
|
|
||||||
|
/*cw_cfg_set_val(params->cfg, key,
|
||||||
|
handler->type, handler->param, elem_data+1,elem_len-1);*/
|
||||||
|
|
||||||
|
type->read(params->cfg, key,elem_data+1,elem_len-1,handler->param);
|
||||||
|
return CAPWAP_RESULT_SUCCESS;
|
||||||
|
}
|
||||||
|
|
||||||
|
int cw_out_radio_generic(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params
|
||||||
|
, uint8_t * dst)
|
||||||
|
{
|
||||||
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
|
struct cw_Type * type;
|
||||||
|
|
||||||
|
int len,i,l,start;
|
||||||
|
int radios;
|
||||||
|
len =0;
|
||||||
|
|
||||||
|
radios = cw_cfg_get_byte_l(params->cfg_list,"wtp-descriptor/max-radios",0);
|
||||||
|
for(i=0;i<radios;i++){
|
||||||
|
|
||||||
|
type = (struct cw_Type*)handler->type;
|
||||||
|
start = params->msgset->header_len(handler)+len;
|
||||||
|
|
||||||
|
sprintf(key,"radio.%d/%s",i,handler->key);
|
||||||
|
// cw_dbg(DBG_X,"KEY: %s",key);
|
||||||
|
|
||||||
|
l = type->write(params->cfg_list, key,dst+start+1,handler->param);
|
||||||
|
if (l==-1)
|
||||||
|
continue;
|
||||||
|
|
||||||
|
l += cw_put_byte(dst+start,i);
|
||||||
|
|
||||||
|
l = params->msgset->write_header(handler,dst+len,l);
|
||||||
|
len+=l;
|
||||||
|
|
||||||
|
}
|
||||||
|
return len;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
int cw_write_header(struct cw_ElemHandler * handler, uint8_t * dst, int len)
|
||||||
|
{
|
||||||
|
if (handler->vendor)
|
||||||
|
return len + cw_put_elem_vendor_hdr(dst, handler->vendor, handler->id, len);
|
||||||
|
|
||||||
|
return len + cw_put_elem_hdr(dst, handler->id, len);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
int cw_header_len(struct cw_ElemHandler * handler)
|
||||||
|
{
|
||||||
|
return handler->vendor ? 10 : 4;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
40
src/cw/cw.h
40
src/cw/cw.h
@ -327,7 +327,7 @@ int cw_put_elem_result_code(uint8_t * dst, uint32_t code);
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
/*extern int cw_put_ac_status(uint8_t * dst, struct cw_ac_status *s, struct conn *conn);*/
|
/*extern int cw_put_ac_status(uint8_t * dst, struct cw_ac_status *s, struct cw_Conn *conn);*/
|
||||||
|
|
||||||
|
|
||||||
struct cw_DescriptorSubelemDef {
|
struct cw_DescriptorSubelemDef {
|
||||||
@ -348,7 +348,8 @@ struct cw_DescriptorSubelemDef {
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
int cw_check_missing_mand(struct cw_MsgData *msgdata, mavl_t keys );
|
//int cw_check_missing_mand(struct cw_MsgData *msgdata, mavl_t keys );
|
||||||
|
int cw_check_missing_mand(struct cw_MsgData *msgdata, mavl_t keys, mavl_t handlers_by_key );
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
@ -356,23 +357,23 @@ extern int cw_read_descriptor_subelems(mavl_t store, const char * key, uint8_t *
|
|||||||
struct cw_DescriptorSubelemDef *elems);
|
struct cw_DescriptorSubelemDef *elems);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
int cw_read_wtp_descriptor(mavl_t mbag, struct conn *conn,
|
int cw_read_wtp_descriptor(mavl_t mbag, struct cw_Conn *conn,
|
||||||
struct cw_ElemHandler *eh, uint8_t * data, int len,
|
struct cw_ElemHandler *eh, uint8_t * data, int len,
|
||||||
struct cw_DescriptorSubelemDef *allowed);
|
struct cw_DescriptorSubelemDef *allowed);
|
||||||
*/
|
*/
|
||||||
|
|
||||||
int cw_read_wtp_descriptor(mavl_t mbag, struct conn *conn,
|
int cw_read_wtp_descriptor(mavl_t mbag, struct cw_Conn *conn,
|
||||||
struct cw_ElemHandler *eh, uint8_t * data, int len,
|
struct cw_ElemHandler *eh, uint8_t * data, int len,
|
||||||
struct cw_DescriptorSubelemDef *allowed);
|
struct cw_DescriptorSubelemDef *allowed);
|
||||||
|
|
||||||
int cw_write_descriptor_subelem (uint8_t *dst, mavl_t ktvstore,
|
int cw_write_descriptor_subelem (uint8_t *dst, cw_Cfg_t ** cfg_list,
|
||||||
int subelem_id, const char * parent_key);
|
int subelem_id, const char * parent_key);
|
||||||
|
|
||||||
int cw_write_radio_element(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params, int idx,
|
int cw_write_radio_element(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params, int idx,
|
||||||
uint8_t * dst);
|
uint8_t * dst);
|
||||||
|
|
||||||
|
|
||||||
extern int cw_read_wtp_descriptor_7(mavl_t mbag, struct conn *conn,
|
extern int cw_read_wtp_descriptor_7(mavl_t mbag, struct cw_Conn *conn,
|
||||||
struct cw_ElemHandler *eh, uint8_t * data, int len,
|
struct cw_ElemHandler *eh, uint8_t * data, int len,
|
||||||
struct cw_DescriptorSubelemDef *allowed);
|
struct cw_DescriptorSubelemDef *allowed);
|
||||||
|
|
||||||
@ -384,7 +385,7 @@ int cw_read_ac_descriptor(mavl_t store,
|
|||||||
struct cw_DescriptorSubelemDef *allowed);
|
struct cw_DescriptorSubelemDef *allowed);
|
||||||
|
|
||||||
|
|
||||||
int cw_setup_dtls(struct conn * conn, mavl_t cfg, const char *prefix, char * default_cipher);
|
int cw_setup_dtls(struct cw_Conn * conn, mavl_t cfg, const char *prefix, char * default_cipher);
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
@ -444,11 +445,11 @@ int cw_out_radio_generic(struct cw_ElemHandler * handler, struct cw_ElemHandlerP
|
|||||||
int cw_out_radio_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params
|
int cw_out_radio_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params
|
||||||
, uint8_t * dst);
|
, uint8_t * dst);
|
||||||
|
|
||||||
extern int cw_in_wtp_reboot_statistics(struct conn *conn, struct cw_action_in *a,
|
extern int cw_in_wtp_reboot_statistics(struct cw_Conn *conn, struct cw_action_in *a,
|
||||||
uint8_t * data, int len, struct sockaddr *from);
|
uint8_t * data, int len, struct sockaddr *from);
|
||||||
|
|
||||||
|
|
||||||
extern int cw_in_wtp_board_data(struct conn *conn, struct cw_action_in *a, uint8_t * data,
|
extern int cw_in_wtp_board_data(struct cw_Conn *conn, struct cw_action_in *a, uint8_t * data,
|
||||||
int len, struct sockaddr *from);
|
int len, struct sockaddr *from);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
@ -457,24 +458,24 @@ int cw_in_vendor_specific_payload(struct cw_ElemHandler *handler,
|
|||||||
uint8_t * data, int len);
|
uint8_t * data, int len);
|
||||||
*/
|
*/
|
||||||
|
|
||||||
extern int cw_in_capwap_control_ip_address(struct conn *conn, struct cw_action_in *a,
|
extern int cw_in_capwap_control_ip_address(struct cw_Conn *conn, struct cw_action_in *a,
|
||||||
uint8_t * data, int len,
|
uint8_t * data, int len,
|
||||||
struct sockaddr *from);
|
struct sockaddr *from);
|
||||||
|
|
||||||
extern int cw_in_capwap_local_ipv4_address(struct conn *conn, struct cw_action_in *a,
|
extern int cw_in_capwap_local_ipv4_address(struct cw_Conn *conn, struct cw_action_in *a,
|
||||||
uint8_t * data, int len,
|
uint8_t * data, int len,
|
||||||
struct sockaddr *from);
|
struct sockaddr *from);
|
||||||
|
|
||||||
extern int cw_in_capwap_local_ipv6_address(struct conn *conn, struct cw_action_in *a,
|
extern int cw_in_capwap_local_ipv6_address(struct cw_Conn *conn, struct cw_action_in *a,
|
||||||
uint8_t * data, int len,
|
uint8_t * data, int len,
|
||||||
struct sockaddr *from);
|
struct sockaddr *from);
|
||||||
|
|
||||||
extern int cw_in_radio_operational_state(struct conn *conn, struct cw_action_in *a,
|
extern int cw_in_radio_operational_state(struct cw_Conn *conn, struct cw_action_in *a,
|
||||||
uint8_t * data, int len, struct sockaddr *from);
|
uint8_t * data, int len, struct sockaddr *from);
|
||||||
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
int cw_process_element(struct conn * conn,
|
int cw_process_element(struct cw_Conn * conn,
|
||||||
struct cw_MsgData * msgdata, int proto, int vendor,
|
struct cw_MsgData * msgdata, int proto, int vendor,
|
||||||
uint8_t * elem, int max_len);
|
uint8_t * elem, int max_len);
|
||||||
*/
|
*/
|
||||||
@ -502,7 +503,7 @@ int cw_process_element(struct cw_ElemHandlerParams *params,
|
|||||||
#define cw_out_capwap_local_ip_address_7 cw_out_wtp_ip_address
|
#define cw_out_capwap_local_ip_address_7 cw_out_wtp_ip_address
|
||||||
|
|
||||||
|
|
||||||
void cw_init_request(struct conn *conn, int msg_id);
|
void cw_init_request(struct cw_Conn *conn, int msg_id);
|
||||||
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
@ -527,16 +528,16 @@ int cw_put_elem_radio_administrative_state(uint8_t * dst, int rid, int state);
|
|||||||
int cw_put_local_ip_address(uint8_t *dst, int id, int ipv_id, int ipv6_id,
|
int cw_put_local_ip_address(uint8_t *dst, int id, int ipv_id, int ipv6_id,
|
||||||
uint8_t *src, int len);
|
uint8_t *src, int len);
|
||||||
|
|
||||||
int cw_detect_nat(struct conn *conn);
|
int cw_detect_nat(struct cw_ElemHandlerParams *conn);
|
||||||
|
|
||||||
uint8_t *cw_init_data_keep_alive_msg(uint8_t * buffer,uint8_t *rmac);
|
uint8_t *cw_init_data_keep_alive_msg(uint8_t * buffer,uint8_t *rmac);
|
||||||
|
|
||||||
/*int cw_out_radio_generic(struct conn *conn, struct cw_action_out *a, uint8_t * dst);*/
|
/*int cw_out_radio_generic(struct cw_Conn *conn, struct cw_action_out *a, uint8_t * dst);*/
|
||||||
|
|
||||||
int cw_put_elem_session_id(uint8_t *dst, uint8_t *session_id, int len);
|
int cw_put_elem_session_id(uint8_t *dst, uint8_t *session_id, int len);
|
||||||
|
|
||||||
int cw_result_is_ok( int rc );
|
int cw_result_is_ok( int rc );
|
||||||
int cw_put_msg(struct conn *conn, uint8_t * rawout);
|
int cw_assemble_message(struct cw_Conn *conn, uint8_t * rawout);
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @}
|
* @}
|
||||||
@ -550,6 +551,9 @@ int cw_stricmp(char const *a, char const *b);
|
|||||||
int cw_write_header(struct cw_ElemHandler * handler, uint8_t * dst, int len);
|
int cw_write_header(struct cw_ElemHandler * handler, uint8_t * dst, int len);
|
||||||
int cw_header_len(struct cw_ElemHandler * handler);
|
int cw_header_len(struct cw_ElemHandler * handler);
|
||||||
|
|
||||||
|
int cw_compose_message(struct cw_Conn *conn, uint8_t * rawout);
|
||||||
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
*@}
|
*@}
|
||||||
*/
|
*/
|
||||||
|
@ -3,7 +3,7 @@
|
|||||||
#include "dbg.h"
|
#include "dbg.h"
|
||||||
#include "log.h"
|
#include "log.h"
|
||||||
|
|
||||||
int cw_check_missing_mand(struct cw_MsgData *msgdata, mavl_t keys )
|
int cw_check_missing_mand(struct cw_MsgData *msgdata, mavl_t keys, mavl_t handlers_by_key )
|
||||||
{
|
{
|
||||||
mlistelem_t * elem;
|
mlistelem_t * elem;
|
||||||
char *mandkey, *result;
|
char *mandkey, *result;
|
||||||
@ -26,7 +26,22 @@ int cw_check_missing_mand(struct cw_MsgData *msgdata, mavl_t keys )
|
|||||||
}
|
}
|
||||||
|
|
||||||
mlist_foreach(elem,missing){
|
mlist_foreach(elem,missing){
|
||||||
cw_dbg(DBG_RFC," Missing mandatory message element: %s", mlistelem_get_str(elem));
|
const char * str;
|
||||||
|
struct cw_ElemHandler search, *result;
|
||||||
|
|
||||||
|
str = mlistelem_get_str(elem);
|
||||||
|
|
||||||
|
search.key = str;
|
||||||
|
result = mavl_get(handlers_by_key,&search);
|
||||||
|
if (result == NULL){
|
||||||
|
cw_log(LOG_ERR,"Can't find handler for for key %s",str);
|
||||||
|
}
|
||||||
|
else {
|
||||||
|
cw_dbg(DBG_RFC,"Missing mandatory message element: %s: %d - %s",
|
||||||
|
str,result->id, result->name);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
count = missing->count;
|
count = missing->count;
|
||||||
|
@ -1,126 +0,0 @@
|
|||||||
#include "cw.h"
|
|
||||||
#include "dbg.h"
|
|
||||||
#include "log.h"
|
|
||||||
#include "msgset.h"
|
|
||||||
|
|
||||||
int cw_decode_element(struct cw_ElemHandlerParams *params, int proto,
|
|
||||||
int vendor, int elem_id, uint8_t * data, int len)
|
|
||||||
{
|
|
||||||
|
|
||||||
struct cw_ElemHandler *handler;
|
|
||||||
struct cw_ElemData *elem_data, elem_data_search;
|
|
||||||
int rc;
|
|
||||||
|
|
||||||
params->elem = NULL;
|
|
||||||
|
|
||||||
/* try to retrieve a handler for this message element */
|
|
||||||
handler =
|
|
||||||
cw_msgset_get_elemhandler(params->msgset, proto, vendor,
|
|
||||||
elem_id);
|
|
||||||
if (!handler) {
|
|
||||||
|
|
||||||
cw_dbg(DBG_ELEM_ERR,
|
|
||||||
"Unrecognized message element: %d, ignoring", elem_id);
|
|
||||||
return CAPWAP_RESULT_UNRECOGNIZED_MESSAGE_ELEMENT;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* check if this message element in the current message allowed */
|
|
||||||
elem_data_search.id = elem_id;
|
|
||||||
elem_data_search.proto = proto;
|
|
||||||
elem_data_search.vendor = vendor;
|
|
||||||
elem_data = mavl_get(params->msgdata->elements_tree, &elem_data_search);
|
|
||||||
if (!elem_data) {
|
|
||||||
cw_dbg(DBG_ELEM_ERR, "Element %d - %s, not allowed here",
|
|
||||||
elem_id, handler->name);
|
|
||||||
return CAPWAP_RESULT_UNRECOGNIZED_MESSAGE_ELEMENT;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* check the length of the message */
|
|
||||||
if (len < handler->min_len) {
|
|
||||||
cw_dbg(DBG_ELEM_ERR,
|
|
||||||
"%d (%s) message element too short, len=%d, min len=%d",
|
|
||||||
handler->id, handler->name, len, handler->min_len);
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
if (elem_data->mand) {
|
|
||||||
mavl_add_str(params->mand_found, handler->key);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
if (len > handler->max_len && handler->max_len) {
|
|
||||||
cw_dbg(DBG_ELEM_ERR,
|
|
||||||
"%d (%s) message element too big, len=%d, max len=%d",
|
|
||||||
handler->id, handler->name, len, handler->max_len);
|
|
||||||
/* TODO XXX truncate the element instead of return */
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
cw_dbg_elem(DBG_ELEM_IN, NULL, params->msgdata->type, handler,
|
|
||||||
data, len);
|
|
||||||
|
|
||||||
if (handler->get == NULL) {
|
|
||||||
cw_log(LOG_ERR, "No get method defined for %d %s", handler->id,
|
|
||||||
handler->name);
|
|
||||||
return CAPWAP_RESULT_UNRECOGNIZED_MESSAGE_ELEMENT;
|
|
||||||
}
|
|
||||||
|
|
||||||
printf ("USING HANDLERi TO DECODE: %d %s\n",handler->id,handler->name);
|
|
||||||
rc = handler->get(handler, params, data, len);
|
|
||||||
|
|
||||||
|
|
||||||
return rc;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
int cw_decode_elements(struct cw_ElemHandlerParams * params, uint8_t * elems_ptr, int elems_len)
|
|
||||||
{
|
|
||||||
uint8_t *elem;
|
|
||||||
mavl_t mand_found;
|
|
||||||
mlist_t unrecognized;
|
|
||||||
|
|
||||||
mand_found = mavl_create_conststr();
|
|
||||||
unrecognized = mlist_create(NULL,NULL,sizeof(uint8_t*));
|
|
||||||
|
|
||||||
cw_foreach_elem(elem, elems_ptr, elems_len) {
|
|
||||||
int rc;
|
|
||||||
|
|
||||||
int elem_len, elem_id, max_len;
|
|
||||||
uint8_t * elem_data;
|
|
||||||
|
|
||||||
|
|
||||||
elem_len = cw_get_elem_len(elem);
|
|
||||||
elem_data=cw_get_elem_data(elem);
|
|
||||||
elem_id = cw_get_elem_id(elem);
|
|
||||||
|
|
||||||
max_len=elems_len-(elem_data-elems_ptr);
|
|
||||||
if (elem_len > max_len){
|
|
||||||
cw_dbg(DBG_RFC,
|
|
||||||
"Messag element claims size of %d bytes, but only %d bytes are left in the payload, truncating.",
|
|
||||||
elem_len,max_len-4);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
params->from=NULL; /*from;*/
|
|
||||||
params->mand_found=mand_found;
|
|
||||||
|
|
||||||
rc = cw_decode_element(params,0,0,elem_id,elem_data,elem_len);
|
|
||||||
|
|
||||||
|
|
||||||
if (cw_result_is_ok(rc))
|
|
||||||
continue;
|
|
||||||
|
|
||||||
if (rc == CAPWAP_RESULT_UNRECOGNIZED_MESSAGE_ELEMENT){
|
|
||||||
mlist_append(unrecognized,&elem);
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (rc < 0 ){
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
@ -10,15 +10,13 @@
|
|||||||
* @retval 1 NAT detected
|
* @retval 1 NAT detected
|
||||||
* @retval 0 no NAT was detected
|
* @retval 0 no NAT was detected
|
||||||
*/
|
*/
|
||||||
int cw_detect_nat(struct conn *conn)
|
int cw_detect_nat(struct cw_ElemHandlerParams *params)
|
||||||
{
|
{
|
||||||
cw_Val_t * result;
|
const char * remote_str;
|
||||||
|
|
||||||
char local_str[128];
|
char local_str[128];
|
||||||
char remote_str[128];
|
|
||||||
|
|
||||||
result = cw_ktv_get(conn->remote_cfg,"capwap-local-ip-address",CW_TYPE_IPADDRESS);
|
remote_str = cw_cfg_get(params->cfg,"capwap-local-ip-address",NULL);
|
||||||
if (result == NULL){
|
if (remote_str == NULL){
|
||||||
cw_dbg(DBG_WARN,"Can't detect NAT. No local IP from peer received.");
|
cw_dbg(DBG_WARN,"Can't detect NAT. No local IP from peer received.");
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
@ -26,8 +24,7 @@ int cw_detect_nat(struct conn *conn)
|
|||||||
/* convert remote connected and sent ip addresse to
|
/* convert remote connected and sent ip addresse to
|
||||||
* strings */
|
* strings */
|
||||||
|
|
||||||
sock_addrtostr((struct sockaddr*)&conn->addr,local_str,128,0);
|
sock_addrtostr((struct sockaddr*)&(params->conn->addr),local_str,128,0);
|
||||||
result->type->to_str(result,remote_str,128);
|
|
||||||
|
|
||||||
|
|
||||||
/* if connected and sent address is the same, there is
|
/* if connected and sent address is the same, there is
|
||||||
@ -37,3 +34,4 @@ int cw_detect_nat(struct conn *conn)
|
|||||||
/* otherwise ther must be something between AC and WTP */
|
/* otherwise ther must be something between AC and WTP */
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -35,10 +35,6 @@ int cw_format_version(char *s, const uint8_t * version, int len)
|
|||||||
}
|
}
|
||||||
rs += sprintf(s + rs, ")");
|
rs += sprintf(s + rs, ")");
|
||||||
}
|
}
|
||||||
/*
|
|
||||||
vendor = bstrv_get_vendor_id(ver);
|
|
||||||
rs += sprintf(s + rs, ", Vendor Id: %d, %s", vendor, cw_strvendor(vendor));
|
|
||||||
*/
|
|
||||||
return rs;
|
return rs;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -9,7 +9,7 @@
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
int cw_in_capwap_local_ipv6_address(struct conn *conn, struct cw_action_in *a,
|
int cw_in_capwap_local_ipv6_address(struct cw_Conn *conn, struct cw_action_in *a,
|
||||||
uint8_t * data, int len,struct sockaddr *from)
|
uint8_t * data, int len,struct sockaddr *from)
|
||||||
{
|
{
|
||||||
struct sockaddr_in6 addr;
|
struct sockaddr_in6 addr;
|
||||||
|
@ -1,32 +0,0 @@
|
|||||||
|
|
||||||
|
|
||||||
#include "capwap.h"
|
|
||||||
#include "intavltree.h"
|
|
||||||
#include "dbg.h"
|
|
||||||
#include "log.h"
|
|
||||||
|
|
||||||
|
|
||||||
int cw_in_check_cfg_update_req(struct conn *conn, struct cw_action_in *a, uint8_t * data,
|
|
||||||
int len,struct sockaddr *from)
|
|
||||||
{
|
|
||||||
|
|
||||||
/*cw_action_in_t * mlist[60];*/
|
|
||||||
|
|
||||||
/* Check for mandatory elements */
|
|
||||||
/* int n = cw_check_missing_mand(mlist,conn,a);
|
|
||||||
if (n) {
|
|
||||||
if ( conn->strict_capwap ){
|
|
||||||
cw_dbg_missing_mand(DBG_MSG_ERR,conn,mlist,n,a);
|
|
||||||
conn->capwap_state=CAPWAP_STATE_JOIN;
|
|
||||||
return CW_RESULT_MISSING_MAND_ELEM;
|
|
||||||
}
|
|
||||||
cw_dbg_missing_mand(DBG_RFC,conn,mlist,n,a);
|
|
||||||
}
|
|
||||||
*/
|
|
||||||
|
|
||||||
/* set result code to ok and change to configure state */
|
|
||||||
/*mbag_set_dword(conn->outgoing,CW_ITEM_RESULT_CODE,0);*/
|
|
||||||
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
@ -1,43 +0,0 @@
|
|||||||
|
|
||||||
#include "capwap.h"
|
|
||||||
|
|
||||||
|
|
||||||
#include "intavltree.h"
|
|
||||||
#include "log.h"
|
|
||||||
#include "dbg.h"
|
|
||||||
#include "sock.h"
|
|
||||||
|
|
||||||
int cw_in_check_disc_req(struct conn *conn, struct cw_action_in *a, uint8_t * data,
|
|
||||||
int len,struct sockaddr *from)
|
|
||||||
{
|
|
||||||
/*
|
|
||||||
char sock_buf[SOCK_ADDR_BUFSIZE];
|
|
||||||
|
|
||||||
cw_action_in_t *mlist[120];
|
|
||||||
int n = cw_check_missing_mand(mlist, conn, a);
|
|
||||||
|
|
||||||
conn->capwap_state = CW_STATE_NONE;
|
|
||||||
|
|
||||||
|
|
||||||
if (n && conn->strict_capwap) {
|
|
||||||
cw_dbg_missing_mand(DBG_MSG_ERR, conn, mlist, n, a);
|
|
||||||
// if mandatory elements are missing, in strict
|
|
||||||
// mode send no discovery response
|
|
||||||
cw_dbg(DBG_MSG_ERR,
|
|
||||||
"Ignoring Discovery Request from %s - missing mandatory elements.",
|
|
||||||
sock_addr2str(from,sock_buf));
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( n ) {
|
|
||||||
// put a warning here
|
|
||||||
cw_dbg_missing_mand(DBG_RFC, conn, mlist, n, a);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
// ok, send response
|
|
||||||
conn->capwap_state = CAPWAP_STATE_JOIN;
|
|
||||||
*/
|
|
||||||
return 0;
|
|
||||||
}
|
|
@ -1,44 +0,0 @@
|
|||||||
|
|
||||||
#include "capwap.h"
|
|
||||||
#include "intavltree.h"
|
|
||||||
#include "dbg.h"
|
|
||||||
#include "log.h"
|
|
||||||
|
|
||||||
#include "format.h"
|
|
||||||
#include "connlist.h"
|
|
||||||
|
|
||||||
int cw_in_check_join_req(struct conn *conn, struct cw_action_in *a, uint8_t * data,
|
|
||||||
int len,struct sockaddr *from)
|
|
||||||
{
|
|
||||||
/*
|
|
||||||
cw_action_in_t * mlist[60];
|
|
||||||
|
|
||||||
//Check for mandatory elements
|
|
||||||
int n = cw_check_missing_mand(mlist,conn,a);
|
|
||||||
if (n) {
|
|
||||||
if ( conn->strict_capwap ){
|
|
||||||
cw_dbg_missing_mand(DBG_MSG_ERR,conn,mlist,n,a);
|
|
||||||
conn->capwap_state=CAPWAP_STATE_JOIN;
|
|
||||||
return CW_RESULT_MISSING_MAND_ELEM;
|
|
||||||
}
|
|
||||||
cw_dbg_missing_mand(DBG_RFC,conn,mlist,n,a);
|
|
||||||
}
|
|
||||||
|
|
||||||
connlist_lock(conn->connlist);
|
|
||||||
struct conn *cc = connlist_get_by_session_id(conn->connlist,conn);
|
|
||||||
if (!cc){
|
|
||||||
connlist_add_by_session_id(conn->connlist,conn);
|
|
||||||
}
|
|
||||||
connlist_unlock(conn->connlist);
|
|
||||||
if (cc){
|
|
||||||
cw_dbg(DBG_ELEM_ERR,"Session already in use %s",format_bin2hex(conn->session_id,16));
|
|
||||||
conn->capwap_state=CAPWAP_STATE_JOIN;
|
|
||||||
return CW_RESULT_JOIN_FAILURE_SESSION_ALREADY_IN_USE;
|
|
||||||
}
|
|
||||||
|
|
||||||
// set result code to ok and change to configure state
|
|
||||||
mbag_set_dword(conn->outgoing,CW_ITEM_RESULT_CODE,0);
|
|
||||||
conn->capwap_state = CW_STATE_CONFIGURE;
|
|
||||||
*/
|
|
||||||
return 0;
|
|
||||||
}
|
|
@ -1,47 +0,0 @@
|
|||||||
|
|
||||||
#include <errno.h>
|
|
||||||
|
|
||||||
#include "capwap.h"
|
|
||||||
#include "intavltree.h"
|
|
||||||
#include "dbg.h"
|
|
||||||
#include "log.h"
|
|
||||||
|
|
||||||
|
|
||||||
int cw_in_check_join_resp(struct conn *conn, struct cw_action_in *a, uint8_t * data,
|
|
||||||
int len,struct sockaddr *from)
|
|
||||||
{
|
|
||||||
/*
|
|
||||||
cw_action_in_t * mlist[60];
|
|
||||||
|
|
||||||
mbag_item_t * jresult = mbag_get(conn->incomming,CW_ITEM_RESULT_CODE);
|
|
||||||
if (jresult ) {
|
|
||||||
if (!cw_result_is_ok(jresult->u2.dword)){
|
|
||||||
return jresult->u2.dword;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
// Check for mandatory elements
|
|
||||||
int n = cw_check_missing_mand(mlist,conn,a);
|
|
||||||
if (n && conn->strict_capwap) {
|
|
||||||
cw_dbg_missing_mand(DBG_MSG_ERR,conn,mlist,n,a);
|
|
||||||
conn->capwap_state=CAPWAP_STATE_JOIN;
|
|
||||||
errno=EAGAIN;
|
|
||||||
return -1; //CW_RESULT_MISSING_MAND_ELEM;
|
|
||||||
}
|
|
||||||
if (n){
|
|
||||||
cw_dbg_missing_mand(DBG_RFC,conn,mlist,n,a);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
if ( jresult ) {
|
|
||||||
return jresult->u2.dword;
|
|
||||||
}
|
|
||||||
|
|
||||||
// set result code to ok and change to configure state
|
|
||||||
// mbag_set_dword(conn->outgoing,CW_ITEM_RESULT_CODE,0);
|
|
||||||
*/
|
|
||||||
return 0;
|
|
||||||
}
|
|
@ -3,19 +3,35 @@
|
|||||||
#include "msgset.h"
|
#include "msgset.h"
|
||||||
#include "val.h"
|
#include "val.h"
|
||||||
#include "log.h"
|
#include "log.h"
|
||||||
|
#include "dbg.h"
|
||||||
|
|
||||||
int cw_in_generic(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params,
|
int cw_in_generic(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params,
|
||||||
uint8_t * elem_data, int elem_len)
|
uint8_t * elem_data, int elem_len)
|
||||||
{
|
{
|
||||||
cw_Val_t * result;
|
cw_Type_t * type;
|
||||||
|
type = (cw_Type_t*)handler->type;
|
||||||
|
char mkey[CW_CFG_MAX_KEY_LEN];
|
||||||
|
const char *key;
|
||||||
|
|
||||||
if (!handler->type){
|
|
||||||
|
|
||||||
|
if (!type){
|
||||||
cw_log(LOG_ERR,"Can't handle element: %s, no type defined",handler->name);
|
cw_log(LOG_ERR,"Can't handle element: %s, no type defined",handler->name);
|
||||||
return CAPWAP_RESULT_UNRECOGNIZED_MESSAGE_ELEMENT;
|
return CAPWAP_RESULT_UNRECOGNIZED_MESSAGE_ELEMENT;
|
||||||
}
|
}
|
||||||
|
|
||||||
result = cw_ktv_add(params->remote_cfg, handler->key,
|
if (handler->mkkey != NULL){
|
||||||
handler->type,NULL, elem_data,elem_len);
|
handler->mkkey(handler->key,elem_data,elem_len, mkey);
|
||||||
params->elem=result;
|
key = mkey;
|
||||||
|
}
|
||||||
|
else{
|
||||||
|
key = handler->key;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/* cw_dbg(DBG_X, "READ: %s / %s",type->name,key);*/
|
||||||
|
type->read(params->cfg, key,elem_data,elem_len,handler->param);
|
||||||
return CAPWAP_RESULT_SUCCESS;
|
return CAPWAP_RESULT_SUCCESS;
|
||||||
}
|
}
|
||||||
|
@ -17,7 +17,7 @@ int cw_in_generic_enum(struct cw_ElemHandler * handler, struct cw_ElemHandlerPar
|
|||||||
{
|
{
|
||||||
int val;
|
int val;
|
||||||
const cw_ValEnum_t * e;
|
const cw_ValEnum_t * e;
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
struct cw_ElemHandler thandler;
|
struct cw_ElemHandler thandler;
|
||||||
|
|
||||||
val = cw_get_byte(elem_data+1);
|
val = cw_get_byte(elem_data+1);
|
||||||
|
@ -1,6 +1,8 @@
|
|||||||
|
|
||||||
|
|
||||||
#include "cw.h"
|
#include "cw.h"
|
||||||
|
#include "cfg.h"
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
static const cw_ValEnum_t * get_enum(const cw_ValEnum_t * e, int val){
|
static const cw_ValEnum_t * get_enum(const cw_ValEnum_t * e, int val){
|
||||||
@ -21,7 +23,7 @@ int cw_in_generic_indexed_enum(struct cw_ElemHandler * handler, struct cw_ElemHa
|
|||||||
const cw_ValEnum_t * e;
|
const cw_ValEnum_t * e;
|
||||||
const cw_ValIndexed_t * ie;
|
const cw_ValIndexed_t * ie;
|
||||||
|
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
struct cw_ElemHandler thandler;
|
struct cw_ElemHandler thandler;
|
||||||
|
|
||||||
ie = handler->type;
|
ie = handler->type;
|
||||||
@ -46,8 +48,11 @@ int cw_in_generic_indexed_enum(struct cw_ElemHandler * handler, struct cw_ElemHa
|
|||||||
}
|
}
|
||||||
|
|
||||||
memset(&thandler,0,sizeof(thandler));
|
memset(&thandler,0,sizeof(thandler));
|
||||||
thandler.type=e->type;
|
|
||||||
thandler.key=key;
|
thandler.key=key;
|
||||||
|
|
||||||
|
thandler.type=e->type;
|
||||||
|
thandler.param=e->param;
|
||||||
return e->fun_in(&thandler,params,elem_data+f,elem_len-l);
|
return e->fun_in(&thandler,params,elem_data+f,elem_len-l);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
@ -3,12 +3,16 @@
|
|||||||
#include "msgset.h"
|
#include "msgset.h"
|
||||||
#include "val.h"
|
#include "val.h"
|
||||||
#include "log.h"
|
#include "log.h"
|
||||||
|
#include "dbg.h"
|
||||||
|
|
||||||
int cw_in_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params,
|
int cw_in_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params,
|
||||||
uint8_t * elem_data, int elem_len)
|
uint8_t * elem_data, int elem_len)
|
||||||
{
|
{
|
||||||
|
cw_dbg(DBG_X,"STRUCT KEY: %s",handler->key);
|
||||||
|
stop();
|
||||||
const char * key;
|
const char * key;
|
||||||
char tmpkey[CW_KTV_MAX_KEY_LEN];
|
char tmpkey[CW_CFG_MAX_KEY_LEN];
|
||||||
|
|
||||||
|
|
||||||
if (handler->mkkey != NULL){
|
if (handler->mkkey != NULL){
|
||||||
handler->mkkey(key,elem_data,elem_len, tmpkey);
|
handler->mkkey(key,elem_data,elem_len, tmpkey);
|
||||||
@ -29,7 +33,7 @@ printf("CW_IN_GENERIC STRUCT: %s\n",key);
|
|||||||
return CAPWAP_RESULT_UNRECOGNIZED_MESSAGE_ELEMENT;
|
return CAPWAP_RESULT_UNRECOGNIZED_MESSAGE_ELEMENT;
|
||||||
}
|
}
|
||||||
|
|
||||||
cw_ktv_read_struct(params->remote_cfg,handler->type,key,elem_data,elem_len);
|
cw_ktv_read_struct(params->cfg,handler->type,key,elem_data,elem_len);
|
||||||
|
|
||||||
return CAPWAP_RESULT_SUCCESS;
|
return CAPWAP_RESULT_SUCCESS;
|
||||||
}
|
}
|
||||||
|
@ -1,14 +1,18 @@
|
|||||||
#include "cw.h"
|
#include "cw.h"
|
||||||
|
#include "dbg.h"
|
||||||
|
|
||||||
int cw_in_generic_with_index(struct cw_ElemHandler *eh,
|
int cw_in_generic_with_index(struct cw_ElemHandler *eh,
|
||||||
struct cw_ElemHandlerParams *params,
|
struct cw_ElemHandlerParams *params,
|
||||||
uint8_t * data, int len)
|
uint8_t * data, int len)
|
||||||
{
|
{
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
int idx;
|
int idx;
|
||||||
|
|
||||||
|
cw_dbg(DBG_X,"Fix cw_in_generic_with_index");
|
||||||
|
stop();
|
||||||
idx = cw_get_byte(data);
|
idx = cw_get_byte(data);
|
||||||
sprintf(key,"%s.%d",eh->key,idx);
|
sprintf(key,"%s.%d",eh->key,idx);
|
||||||
cw_ktv_add(params->remote_cfg,key,eh->type,NULL,data+1,len-1);
|
// cw_cfg_add(params->cfg,key,eh->type,NULL,data+1,len-1);
|
||||||
|
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
@ -1,9 +1,12 @@
|
|||||||
#include "cw.h"
|
#include "cw.h"
|
||||||
#include "log.h"
|
#include "log.h"
|
||||||
|
#include "dbg.h"
|
||||||
|
|
||||||
int cw_in_idx_generic(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params,
|
int cw_in_idx_generic(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params,
|
||||||
uint8_t * elem_data, int elem_len)
|
uint8_t * elem_data, int elem_len)
|
||||||
{
|
{
|
||||||
|
stop();
|
||||||
|
/*
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
char key[CW_KTV_MAX_KEY_LEN];
|
||||||
cw_Val_t * result;
|
cw_Val_t * result;
|
||||||
int idx;
|
int idx;
|
||||||
@ -16,10 +19,10 @@ int cw_in_idx_generic(struct cw_ElemHandler * handler, struct cw_ElemHandlerPara
|
|||||||
idx=cw_get_byte(elem_data);
|
idx=cw_get_byte(elem_data);
|
||||||
sprintf(key,handler->key,idx);
|
sprintf(key,handler->key,idx);
|
||||||
|
|
||||||
result = cw_ktv_add(params->remote_cfg, key,
|
result = cw_ktv_add(params->cfg, key,
|
||||||
handler->type, NULL, elem_data+1,elem_len-1);
|
handler->type, NULL, elem_data+1,elem_len-1);
|
||||||
|
|
||||||
params->elem=result;
|
// params->elem=result;
|
||||||
|
*/
|
||||||
return CAPWAP_RESULT_SUCCESS;
|
return CAPWAP_RESULT_SUCCESS;
|
||||||
}
|
}
|
||||||
|
@ -4,13 +4,19 @@
|
|||||||
#include "val.h"
|
#include "val.h"
|
||||||
#include "log.h"
|
#include "log.h"
|
||||||
#include "cw.h"
|
#include "cw.h"
|
||||||
|
#include "dbg.h"
|
||||||
|
|
||||||
|
|
||||||
int cw_in_idx_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params,
|
int cw_in_idx_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params,
|
||||||
uint8_t * elem_data, int elem_len)
|
uint8_t * elem_data, int elem_len)
|
||||||
{
|
{
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
int idx;
|
int idx;
|
||||||
|
|
||||||
|
|
||||||
|
cw_dbg(DBG_X,"Fix cw_in_idx_generic_struct");
|
||||||
|
stop();
|
||||||
|
|
||||||
if (!handler->type){
|
if (!handler->type){
|
||||||
cw_log(LOG_ERR,"Can't handle element: %s, no type defined",handler->name);
|
cw_log(LOG_ERR,"Can't handle element: %s, no type defined",handler->name);
|
||||||
return CAPWAP_RESULT_UNRECOGNIZED_MESSAGE_ELEMENT;
|
return CAPWAP_RESULT_UNRECOGNIZED_MESSAGE_ELEMENT;
|
||||||
@ -19,7 +25,7 @@ int cw_in_idx_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHand
|
|||||||
idx = cw_get_byte(elem_data);
|
idx = cw_get_byte(elem_data);
|
||||||
sprintf(key, handler->key, idx);
|
sprintf(key, handler->key, idx);
|
||||||
|
|
||||||
cw_ktv_read_struct(params->remote_cfg,handler->type,key,elem_data+1,elem_len-1);
|
cw_ktv_read_struct(params->cfg,handler->type,key,elem_data+1,elem_len-1);
|
||||||
|
|
||||||
return CAPWAP_RESULT_SUCCESS;
|
return CAPWAP_RESULT_SUCCESS;
|
||||||
}
|
}
|
||||||
|
@ -5,10 +5,15 @@
|
|||||||
#include "log.h"
|
#include "log.h"
|
||||||
#include "cw.h"
|
#include "cw.h"
|
||||||
|
|
||||||
|
#include "dbg.h"
|
||||||
|
|
||||||
int cw_in_radio_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params,
|
int cw_in_radio_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params,
|
||||||
uint8_t * elem_data, int elem_len)
|
uint8_t * elem_data, int elem_len)
|
||||||
{
|
{
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
|
||||||
|
stop();
|
||||||
|
|
||||||
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
int radio;
|
int radio;
|
||||||
|
|
||||||
if (!handler->type){
|
if (!handler->type){
|
||||||
@ -19,7 +24,7 @@ int cw_in_radio_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHa
|
|||||||
radio = cw_get_byte(elem_data);
|
radio = cw_get_byte(elem_data);
|
||||||
sprintf(key,"radio.%d/%s",radio,handler->key);
|
sprintf(key,"radio.%d/%s",radio,handler->key);
|
||||||
|
|
||||||
cw_ktv_read_struct(params->remote_cfg,handler->type,key,elem_data+1,elem_len-1);
|
cw_ktv_read_struct(params->cfg,handler->type,key,elem_data+1,elem_len-1);
|
||||||
|
|
||||||
/*params->elem=result;*/
|
/*params->elem=result;*/
|
||||||
|
|
||||||
|
@ -21,7 +21,7 @@
|
|||||||
#include "log.h"
|
#include "log.h"
|
||||||
|
|
||||||
|
|
||||||
int cw_in_wtp_reboot_statistics(struct conn *conn, struct cw_action_in *a, uint8_t * data,
|
int cw_in_wtp_reboot_statistics(struct cw_Conn *conn, struct cw_action_in *a, uint8_t * data,
|
||||||
int len, struct sockaddr *from)
|
int len, struct sockaddr *from)
|
||||||
{
|
{
|
||||||
/*
|
/*
|
||||||
|
@ -10,7 +10,6 @@ cw_Val_t * cw_ktv_add(mavl_t kvtstore, const char *key, const struct cw_Type *ty
|
|||||||
{
|
{
|
||||||
cw_Val_t mdata, *mresult;
|
cw_Val_t mdata, *mresult;
|
||||||
int exists;
|
int exists;
|
||||||
|
|
||||||
mdata.key=cw_strdup(key);
|
mdata.key=cw_strdup(key);
|
||||||
mdata.valguard=valguard;
|
mdata.valguard=valguard;
|
||||||
|
|
||||||
|
@ -1,22 +0,0 @@
|
|||||||
|
|
||||||
|
|
||||||
#include "val.h"
|
|
||||||
|
|
||||||
void cw_ktv_del_sub(mavl_t ktvstore, const char *basekey)
|
|
||||||
{
|
|
||||||
cw_Val_t * result, search;
|
|
||||||
|
|
||||||
|
|
||||||
while (1){
|
|
||||||
search.key=(char*)basekey;
|
|
||||||
result = mavl_get_first(ktvstore,&search);
|
|
||||||
|
|
||||||
if (result == NULL)
|
|
||||||
return;
|
|
||||||
|
|
||||||
if (strncmp(result->key,basekey,strlen(basekey))!=0)
|
|
||||||
break;
|
|
||||||
search.key = result->key;
|
|
||||||
mavl_del(ktvstore,&search);
|
|
||||||
}
|
|
||||||
}
|
|
@ -1,4 +1,5 @@
|
|||||||
#include "val.h"
|
#include "val.h"
|
||||||
|
#include "cfg.h"
|
||||||
|
|
||||||
void * ktvn(struct mavl *t ,const void *search)
|
void * ktvn(struct mavl *t ,const void *search)
|
||||||
{
|
{
|
||||||
@ -45,7 +46,7 @@ void * ktvn(struct mavl *t ,const void *search)
|
|||||||
|
|
||||||
int cw_ktv_idx_get(mavl_t ktv, const char *key)
|
int cw_ktv_idx_get(mavl_t ktv, const char *key)
|
||||||
{
|
{
|
||||||
char ikey[CW_KTV_MAX_KEY_LEN];
|
char ikey[CW_CFG_MAX_KEY_LEN];
|
||||||
cw_Val_t search, * result;
|
cw_Val_t search, * result;
|
||||||
char *d;
|
char *d;
|
||||||
|
|
||||||
@ -75,7 +76,7 @@ int cw_ktv_idx_get(mavl_t ktv, const char *key)
|
|||||||
|
|
||||||
int cw_ktv_idx_get_next(mavl_t ktv, const char *key, int n)
|
int cw_ktv_idx_get_next(mavl_t ktv, const char *key, int n)
|
||||||
{
|
{
|
||||||
char ikey[CW_KTV_MAX_KEY_LEN];
|
char ikey[CW_CFG_MAX_KEY_LEN];
|
||||||
cw_Val_t search, * result;
|
cw_Val_t search, * result;
|
||||||
char *d;
|
char *d;
|
||||||
int i;
|
int i;
|
||||||
|
@ -1,10 +1,10 @@
|
|||||||
|
|
||||||
#include "val.h"
|
#include "val.h"
|
||||||
|
#include "cfg.h"
|
||||||
|
|
||||||
int cw_ktv_read_file(FILE * file, mavl_t ktv, mavl_t types)
|
int cw_ktv_read_file(FILE * file, mavl_t ktv, mavl_t types)
|
||||||
{
|
{
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
char type[256];
|
char type[256];
|
||||||
char val[2048];
|
char val[2048];
|
||||||
|
|
||||||
|
@ -1,10 +1,11 @@
|
|||||||
#include "val.h"
|
#include "val.h"
|
||||||
#include "dbg.h"
|
#include "dbg.h"
|
||||||
|
#include "cfg.h"
|
||||||
|
|
||||||
int cw_ktv_read_struct(mavl_t ktv,const cw_ValStruct_t * stru, const char *pkey,
|
int cw_ktv_read_struct(mavl_t ktv,const cw_ValStruct_t * stru, const char *pkey,
|
||||||
uint8_t * data, int len)
|
uint8_t * data, int len)
|
||||||
{
|
{
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
int pos, i,l;
|
int pos, i,l;
|
||||||
cw_Val_t * result;
|
cw_Val_t * result;
|
||||||
|
|
||||||
|
@ -1,6 +1,7 @@
|
|||||||
#include <ctype.h>
|
#include <ctype.h>
|
||||||
|
|
||||||
#include "val.h"
|
#include "val.h"
|
||||||
|
#include "cfg.h"
|
||||||
|
|
||||||
struct parser {
|
struct parser {
|
||||||
int line;
|
int line;
|
||||||
@ -10,13 +11,14 @@ struct parser {
|
|||||||
int quote;
|
int quote;
|
||||||
FILE *f;
|
FILE *f;
|
||||||
int (*getc)(struct parser *);
|
int (*getc)(struct parser *);
|
||||||
void (*ungetc)(struct parser *)
|
void (*ungetc)(struct parser *);
|
||||||
};
|
};
|
||||||
|
|
||||||
|
/*
|
||||||
static int pgetc(struct parser *parser)
|
static int pgetc(struct parser *parser)
|
||||||
{
|
{
|
||||||
return fgetc(parser->f);
|
return fgetc(parser->f);
|
||||||
}
|
}*/
|
||||||
|
|
||||||
static int get_char(struct parser *p)
|
static int get_char(struct parser *p)
|
||||||
{
|
{
|
||||||
@ -290,13 +292,13 @@ int cw_ktv_read_line (FILE *f, char * key, char * type, char *val)
|
|||||||
p.quote=0;
|
p.quote=0;
|
||||||
p.f=f;
|
p.f=f;
|
||||||
|
|
||||||
n = read_key (&p,key,CW_KTV_MAX_KEY_LEN);
|
n = read_key (&p,key,CW_CFG_MAX_KEY_LEN);
|
||||||
n = read_type (&p,type,CW_KTV_MAX_KEY_LEN);
|
n = read_type (&p,type,CW_CFG_MAX_KEY_LEN);
|
||||||
if (n==-1){
|
if (n==-1){
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
n = read_val (&p,val,CW_KTV_MAX_KEY_LEN);
|
n = read_val (&p,val,CW_CFG_MAX_KEY_LEN);
|
||||||
if (n==-1){
|
if (n==-1){
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
@ -1,11 +1,12 @@
|
|||||||
#include "val.h"
|
#include "val.h"
|
||||||
#include "dbg.h"
|
#include "dbg.h"
|
||||||
#include "log.h"
|
#include "log.h"
|
||||||
|
#include "cfg.h"
|
||||||
|
|
||||||
int cw_ktv_write_struct(mavl_t ktv, mavl_t def, const cw_ValStruct_t * stru, const char *pkey,
|
int cw_ktv_write_struct(mavl_t ktv, mavl_t def, const cw_ValStruct_t * stru, const char *pkey,
|
||||||
uint8_t * dst)
|
uint8_t * dst)
|
||||||
{
|
{
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
int pos, i;
|
int pos, i;
|
||||||
cw_Val_t * result;
|
cw_Val_t * result;
|
||||||
|
|
||||||
|
@ -1,80 +0,0 @@
|
|||||||
|
|
||||||
#include "cw.h"
|
|
||||||
|
|
||||||
|
|
||||||
#include "dbg.h"
|
|
||||||
#include "log.h"
|
|
||||||
#include "msgset.h"
|
|
||||||
#include "val.h"
|
|
||||||
|
|
||||||
|
|
||||||
int cw_out_generic(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params
|
|
||||||
, uint8_t * dst)
|
|
||||||
{
|
|
||||||
|
|
||||||
struct cw_Val * elem;
|
|
||||||
int start, len, l;
|
|
||||||
|
|
||||||
/* Get the element */
|
|
||||||
/* search.key=(char*)handler->key;
|
|
||||||
elem = mavl_get(params->conn->local_cfg, &search);
|
|
||||||
*/
|
|
||||||
elem = cw_ktv_get(params->local_cfg,handler->key,NULL);
|
|
||||||
|
|
||||||
/* if (elem == NULL && params->conn->default_cfg !=NULL)
|
|
||||||
elem = mavl_get(params->conn->default_cfg, &search);
|
|
||||||
*/
|
|
||||||
if (elem == NULL) {
|
|
||||||
const char *vendor="";
|
|
||||||
if ( handler->vendor ) {
|
|
||||||
vendor=cw_strvendor(handler->vendor);
|
|
||||||
}
|
|
||||||
if ( params->elemdata->mand) {
|
|
||||||
cw_log(LOG_ERR,
|
|
||||||
"Can't put mandatory element %s %d-(%s) into %s. No value for '%s' found.",
|
|
||||||
vendor, handler->id, handler->name, params->msgdata->name
|
|
||||||
, handler->key
|
|
||||||
);
|
|
||||||
}
|
|
||||||
else{
|
|
||||||
/* cw_dbg(DBG_WARN,"No output for element %s%d -(%s) in %s. Item %s not found.",
|
|
||||||
vendor,
|
|
||||||
a->elem_id, cw_strelemp(conn->actions, a->elem_id)
|
|
||||||
, cw_strmsg(a->msg_id),a->item_id);
|
|
||||||
*/
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Size for msg elem header depends on
|
|
||||||
vendor specific payload */
|
|
||||||
/* start = handler->vendor ? 10 : 4; */
|
|
||||||
start = params->msgset->header_len(handler);
|
|
||||||
|
|
||||||
if (cw_ktv_cast(elem,handler->type)==NULL){
|
|
||||||
cw_log(LOG_ERR,"Can't put element '%s'- can't cast from %s to %s for key: %s", handler->name,
|
|
||||||
elem->type->name, ((const cw_Type_t*)handler->type)->name, handler->key);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
len = ((const cw_Type_t*)(handler->type))->put(elem,dst+start);
|
|
||||||
|
|
||||||
/* ((const cw_Type_t*)(handler->type))->to_str(elem,detail,120);
|
|
||||||
sprintf(params->debug_details, " Value = %s", detail);
|
|
||||||
params->elem = elem;*/
|
|
||||||
|
|
||||||
/* if (handler->vendor)
|
|
||||||
return len + cw_put_elem_vendor_hdr(dst, handler->vendor, handler->id, len);
|
|
||||||
|
|
||||||
l = len + cw_put_elem_hdr(dst, handler->id, len); */
|
|
||||||
l = params->msgset->write_header(handler,dst,len);
|
|
||||||
|
|
||||||
cw_dbg_elem(DBG_ELEM_OUT,NULL,params->msgdata->type,handler,dst,l);
|
|
||||||
/* cw_dbg_elem(DBG_ELEM_OUT,params->conn,params->msgdata->type,handler,dst,l);*/
|
|
||||||
|
|
||||||
return l;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
@ -1,11 +1,18 @@
|
|||||||
#include "cw.h"
|
#include "cw.h"
|
||||||
|
#include"dbg.h"
|
||||||
|
#include "cfg.h"
|
||||||
|
|
||||||
|
|
||||||
int cw_out_generic_indexed_enum(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params
|
int cw_out_generic_indexed_enum(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params
|
||||||
, uint8_t * dst)
|
, uint8_t * dst)
|
||||||
{
|
{
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
// cw_dbg(DBG_X,"Fix: cw_out_generic_indexed_enum %s",handler->key);
|
||||||
|
// stop();
|
||||||
|
|
||||||
|
|
||||||
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
int i;
|
int i;
|
||||||
cw_Val_t * result;
|
// cw_Val_t * result;
|
||||||
int len,start;
|
int len,start;
|
||||||
uint8_t * ob;
|
uint8_t * ob;
|
||||||
const cw_ValIndexed_t *ie;
|
const cw_ValIndexed_t *ie;
|
||||||
@ -20,32 +27,42 @@ int cw_out_generic_indexed_enum(struct cw_ElemHandler * handler, struct cw_ElemH
|
|||||||
e = ie->type;
|
e = ie->type;
|
||||||
|
|
||||||
for(i=0; e[i].name!=NULL; i++) {
|
for(i=0; e[i].name!=NULL; i++) {
|
||||||
|
int b;
|
||||||
sprintf(key,"%s/%s",handler->key,e[i].name);
|
sprintf(key,"%s/%s",handler->key,e[i].name);
|
||||||
|
|
||||||
//printf("Her is the Key: %s - %s\n",key, );
|
cw_dbg(DBG_X,"Her is the Key: %s %s\n",key,e[i].name);
|
||||||
|
|
||||||
result = cw_ktv_base_exists(params->local_cfg,key);
|
b = cw_cfg_base_exists_l(params->cfg_list,handler->key);
|
||||||
if (result==NULL)
|
if (!b){
|
||||||
|
stop();
|
||||||
continue;
|
continue;
|
||||||
|
}
|
||||||
start = params->msgset->header_len(handler);
|
start = params->msgset->header_len(handler);
|
||||||
len = 0;
|
len = 0;
|
||||||
if (ie->idxpos==0)
|
if (ie->idxpos==0)
|
||||||
len = 1;
|
len = 1;
|
||||||
|
|
||||||
if (e[i].fun_out==NULL)
|
if (e[i].fun_out==NULL){
|
||||||
len += result->type->put(result,ob+start+len);
|
stop();
|
||||||
else
|
// result =
|
||||||
len += cw_ktv_write_struct(params->local_cfg,
|
// len += result->type->put(result,ob+start+len);
|
||||||
NULL,e[i].type,key,ob+start+len);
|
}
|
||||||
|
else{
|
||||||
|
len += ((cw_Type_t*)e[i].type)->write(params->cfg_list,key,ob+start+len,e[i].param);
|
||||||
|
// len += cw_ktv_write_struct(params->cfg,
|
||||||
|
// NULL,e[i].type,key,ob+start+len);
|
||||||
|
}
|
||||||
|
|
||||||
cw_set_byte(ob+start+ie->idxpos,e[i].value);
|
cw_set_byte(ob+start+ie->idxpos,e[i].value);
|
||||||
if (ie->idxpos==len)
|
if (ie->idxpos==len)
|
||||||
len++;
|
len++;
|
||||||
|
|
||||||
ob += params->msgset->write_header(handler,ob,len);
|
ob += params->msgset->write_header(handler,ob,len);
|
||||||
|
// cw_val_destroy(result);
|
||||||
}
|
}
|
||||||
|
|
||||||
return ob-dst;
|
return ob-dst;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
|
||||||
}
|
}
|
||||||
|
@ -4,9 +4,16 @@
|
|||||||
#include "log.h"
|
#include "log.h"
|
||||||
#include "cw.h"
|
#include "cw.h"
|
||||||
|
|
||||||
|
#include "dbg.h"
|
||||||
|
|
||||||
|
|
||||||
int cw_out_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params
|
int cw_out_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params
|
||||||
, uint8_t * dst)
|
, uint8_t * dst)
|
||||||
{
|
{
|
||||||
|
cw_dbg(DBG_X,"Key: %s",handler->key);
|
||||||
|
stop();
|
||||||
|
|
||||||
|
|
||||||
int start;
|
int start;
|
||||||
int len;
|
int len;
|
||||||
cw_Val_t search, *result;
|
cw_Val_t search, *result;
|
||||||
@ -17,7 +24,7 @@ int cw_out_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHandler
|
|||||||
}
|
}
|
||||||
|
|
||||||
search.key = (char*)handler->key;
|
search.key = (char*)handler->key;
|
||||||
result = mavl_get_first(params->local_cfg,&search);
|
result = mavl_get_first(params->cfg,&search);
|
||||||
if (result == NULL ){
|
if (result == NULL ){
|
||||||
if (params->elemdata->mand)
|
if (params->elemdata->mand)
|
||||||
cw_log(LOG_ERR,"Can't put mandatory message element %s, no data available",handler->name);
|
cw_log(LOG_ERR,"Can't put mandatory message element %s, no data available",handler->name);
|
||||||
@ -32,8 +39,8 @@ int cw_out_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHandler
|
|||||||
|
|
||||||
start = params->msgset->header_len(handler);
|
start = params->msgset->header_len(handler);
|
||||||
|
|
||||||
len = cw_ktv_write_struct(params->local_cfg,
|
len = cw_ktv_write_struct(params->cfg,
|
||||||
params->default_cfg,
|
params->cfg,
|
||||||
handler->type,handler->key,dst+start);
|
handler->type,handler->key,dst+start);
|
||||||
|
|
||||||
return params->msgset->write_header(handler,dst,len);
|
return params->msgset->write_header(handler,dst,len);
|
||||||
|
@ -1,11 +1,13 @@
|
|||||||
|
|
||||||
#include "cw.h"
|
#include "cw.h"
|
||||||
|
#include "dbg.h"
|
||||||
|
|
||||||
int cw_out_generic_with_index(struct cw_ElemHandler * eh,
|
int cw_out_generic_with_index(struct cw_ElemHandler * eh,
|
||||||
struct cw_ElemHandlerParams * params, uint8_t * dst)
|
struct cw_ElemHandlerParams * params, uint8_t * dst)
|
||||||
|
|
||||||
{
|
{
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
stop();
|
||||||
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
int idx;
|
int idx;
|
||||||
cw_Val_t * result, search;
|
cw_Val_t * result, search;
|
||||||
int len,start;
|
int len,start;
|
||||||
@ -18,7 +20,7 @@ int cw_out_generic_with_index(struct cw_ElemHandler * eh,
|
|||||||
do {
|
do {
|
||||||
sprintf(key,"%s.%d",eh->key,idx);
|
sprintf(key,"%s.%d",eh->key,idx);
|
||||||
search.key=key;
|
search.key=key;
|
||||||
result = mavl_get_first(params->local_cfg,&search);
|
result = mavl_get_first(params->cfg,&search);
|
||||||
if (result==NULL)
|
if (result==NULL)
|
||||||
break;
|
break;
|
||||||
if (strncmp(result->key,key,strlen(key))!=0)
|
if (strncmp(result->key,key,strlen(key))!=0)
|
||||||
|
@ -5,7 +5,10 @@
|
|||||||
int cw_out_idx_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params
|
int cw_out_idx_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params
|
||||||
, uint8_t * dst)
|
, uint8_t * dst)
|
||||||
{
|
{
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
|
||||||
|
stop();
|
||||||
|
|
||||||
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
struct cw_Val * elem, search;
|
struct cw_Val * elem, search;
|
||||||
int i;
|
int i;
|
||||||
int idx, sr;
|
int idx, sr;
|
||||||
@ -24,7 +27,7 @@ int cw_out_idx_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHan
|
|||||||
sprintf(key,handler->key,i);
|
sprintf(key,handler->key,i);
|
||||||
search.key=key;
|
search.key=key;
|
||||||
/*elem = mavl_get(params->conn->local_cfg, &search);*/
|
/*elem = mavl_get(params->conn->local_cfg, &search);*/
|
||||||
elem = mavl_get_first(params->local_cfg,&search);
|
elem = mavl_get_first(params->cfg,&search);
|
||||||
if(elem != NULL){
|
if(elem != NULL){
|
||||||
printf("Elem key: %s\n",elem->key);
|
printf("Elem key: %s\n",elem->key);
|
||||||
}
|
}
|
||||||
@ -41,7 +44,7 @@ int cw_out_idx_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHan
|
|||||||
start = mdst + params->msgset->header_len(handler);
|
start = mdst + params->msgset->header_len(handler);
|
||||||
|
|
||||||
len += cw_put_byte(start+len,idx);
|
len += cw_put_byte(start+len,idx);
|
||||||
len += cw_ktv_write_struct(params->local_cfg,NULL, handler->type,key,start+len);
|
len += cw_ktv_write_struct(params->cfg,NULL, handler->type,key,start+len);
|
||||||
|
|
||||||
mdst += params->msgset->write_header(handler,mdst,len);
|
mdst += params->msgset->write_header(handler,mdst,len);
|
||||||
|
|
||||||
|
@ -1,32 +0,0 @@
|
|||||||
|
|
||||||
#include "cw.h"
|
|
||||||
#include "dbg.h"
|
|
||||||
|
|
||||||
int cw_ktv_idx_get_next(mavl_t ktv, const char *key, int n);
|
|
||||||
|
|
||||||
int cw_out_radio_generic(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params
|
|
||||||
, uint8_t * dst)
|
|
||||||
{
|
|
||||||
int len,i,l;
|
|
||||||
int radios;
|
|
||||||
len =0;
|
|
||||||
|
|
||||||
/* int idx=0;*/
|
|
||||||
|
|
||||||
/* while(1){
|
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
|
||||||
sprintf(key,"radio.%d",idx);
|
|
||||||
idx = cw_ktv_idx_get_next(params->conn->local_cfg,key,idx);
|
|
||||||
idx++;
|
|
||||||
}
|
|
||||||
*/
|
|
||||||
radios = cw_ktv_get_byte(params->local_cfg,"wtp-descriptor/max-radios",0);
|
|
||||||
|
|
||||||
for(i=0;i<radios;i++){
|
|
||||||
l = cw_write_radio_element(handler,params,i,dst+len);
|
|
||||||
cw_dbg_elem(DBG_ELEM_OUT,NULL,params->msgdata->type,handler,dst,l);
|
|
||||||
len+=l;
|
|
||||||
}
|
|
||||||
return len;
|
|
||||||
}
|
|
||||||
|
|
@ -7,6 +7,9 @@ int cw_ktv_idx_get_next(mavl_t ktv, const char *key, int n);
|
|||||||
int cw_out_radio_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params
|
int cw_out_radio_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params
|
||||||
, uint8_t * dst)
|
, uint8_t * dst)
|
||||||
{
|
{
|
||||||
|
cw_dbg(DBG_X,"KEY: %s",handler->key);
|
||||||
|
stop();
|
||||||
|
/*
|
||||||
int i,l, offset;
|
int i,l, offset;
|
||||||
|
|
||||||
uint8_t * cdst;
|
uint8_t * cdst;
|
||||||
@ -18,15 +21,15 @@ int cw_out_radio_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemH
|
|||||||
|
|
||||||
i=-1;
|
i=-1;
|
||||||
while(1){
|
while(1){
|
||||||
char basekey[CW_KTV_MAX_KEY_LEN];
|
char basekey[CW_CFG_MAX_KEY_LEN];
|
||||||
cw_Val_t * result;
|
cw_Val_t * result;
|
||||||
|
|
||||||
i = cw_ktv_idx_get_next(params->local_cfg,"radio",i+1);
|
i = cw_ktv_idx_get_next(params->cfg,"radio",i+1);
|
||||||
if (i==-1)
|
if (i==-1)
|
||||||
break;
|
break;
|
||||||
sprintf(basekey,"radio.%d/%s",i,handler->key);
|
sprintf(basekey,"radio.%d/%s",i,handler->key);
|
||||||
|
|
||||||
result = cw_ktv_base_exists(params->local_cfg,basekey);
|
result = cw_ktv_base_exists(params->cfg,basekey);
|
||||||
if (result == NULL){
|
if (result == NULL){
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
@ -34,7 +37,7 @@ int cw_out_radio_generic_struct(struct cw_ElemHandler * handler, struct cw_ElemH
|
|||||||
|
|
||||||
l=0;
|
l=0;
|
||||||
l+=cw_put_byte(cdst+offset+l,i);
|
l+=cw_put_byte(cdst+offset+l,i);
|
||||||
l+= cw_ktv_write_struct(params->local_cfg,NULL, handler->type,basekey,cdst+offset+l);
|
l+= cw_ktv_write_struct(params->cfg,NULL, handler->type,basekey,cdst+offset+l);
|
||||||
|
|
||||||
|
|
||||||
cdst+=params->msgset->write_header(handler,cdst,l);
|
cdst+=params->msgset->write_header(handler,cdst,l);
|
||||||
@ -49,7 +52,7 @@ int cw_out_traverse0(struct cw_ElemHandler * handler, struct cw_ElemHandlerParam
|
|||||||
{
|
{
|
||||||
char *sl;
|
char *sl;
|
||||||
int l;
|
int l;
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
int len;
|
int len;
|
||||||
len = 0;
|
len = 0;
|
||||||
|
|
||||||
@ -59,7 +62,7 @@ printf("Next: %s\n", next);
|
|||||||
if (sl==NULL){
|
if (sl==NULL){
|
||||||
cw_Val_t * result;
|
cw_Val_t * result;
|
||||||
sprintf(key,"%s/%s",current,next);
|
sprintf(key,"%s/%s",current,next);
|
||||||
result = cw_ktv_base_exists(params->local_cfg,key);
|
result = cw_ktv_base_exists(params->cfg,key);
|
||||||
if (result != NULL){
|
if (result != NULL){
|
||||||
int offset;
|
int offset;
|
||||||
int i,l;
|
int i,l;
|
||||||
@ -68,7 +71,7 @@ printf("Next: %s\n", next);
|
|||||||
for (i=0;i<stack[0];i++){
|
for (i=0;i<stack[0];i++){
|
||||||
printf("I=%i\n",stack[i+1]);
|
printf("I=%i\n",stack[i+1]);
|
||||||
}
|
}
|
||||||
l= cw_ktv_write_struct(params->local_cfg,params->default_cfg,
|
l= cw_ktv_write_struct(params->cfg,params->cfg,
|
||||||
handler->type,key,dst+offset);
|
handler->type,key,dst+offset);
|
||||||
|
|
||||||
printf("Write struct len %i\n",l);
|
printf("Write struct len %i\n",l);
|
||||||
@ -96,19 +99,19 @@ printf("current is %s\n", current);
|
|||||||
|
|
||||||
|
|
||||||
printf("Here we are %s\n",key);
|
printf("Here we are %s\n",key);
|
||||||
cw_dbg_ktv_dump(params->local_cfg,DBG_INFO,"start"," ", "end" );
|
cw_dbg_ktv_dump(params->cfg,DBG_INFO,"start"," ", "end" );
|
||||||
i=-1;
|
i=-1;
|
||||||
while(1){
|
while(1){
|
||||||
char basekey[CW_KTV_MAX_KEY_LEN];
|
char basekey[CW_CFG_MAX_KEY_LEN];
|
||||||
cw_Val_t * result;
|
cw_Val_t * result;
|
||||||
|
|
||||||
i = cw_ktv_idx_get_next(params->local_cfg,key,i+1);
|
i = cw_ktv_idx_get_next(params->cfg,key,i+1);
|
||||||
|
|
||||||
if (i==-1)
|
if (i==-1)
|
||||||
break;
|
break;
|
||||||
sprintf(basekey,"%s.%d",key,i);
|
sprintf(basekey,"%s.%d",key,i);
|
||||||
printf("Our basekey is %s\n",basekey);
|
printf("Our basekey is %s\n",basekey);
|
||||||
result = cw_ktv_base_exists(params->local_cfg,basekey);
|
result = cw_ktv_base_exists(params->cfg,basekey);
|
||||||
if (result == NULL){
|
if (result == NULL){
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
@ -121,6 +124,8 @@ printf("current is %s\n", current);
|
|||||||
|
|
||||||
|
|
||||||
return len;
|
return len;
|
||||||
|
*/
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
int cw_out_traverse(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params
|
int cw_out_traverse(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params
|
||||||
@ -128,14 +133,15 @@ int cw_out_traverse(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams
|
|||||||
|
|
||||||
{
|
{
|
||||||
|
|
||||||
char current[CW_KTV_MAX_KEY_LEN];
|
char current[CW_CFG_MAX_KEY_LEN];
|
||||||
int stack[10];
|
int stack[10];
|
||||||
stack[0]=0;
|
stack[0]=0;
|
||||||
|
|
||||||
current[0]=0;
|
current[0]=0;
|
||||||
|
|
||||||
|
stop();
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
// return cw_out_traverse0(handler,params,dst,-1,current,handler->key, stack);
|
||||||
return cw_out_traverse0(handler,params,dst,-1,current,handler->key, stack);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -20,7 +20,7 @@ int cw_process_element(struct cw_ElemHandlerParams *params, int proto, int vendo
|
|||||||
struct cw_ElemData * elem_data, elem_data_search;
|
struct cw_ElemData * elem_data, elem_data_search;
|
||||||
int rc;
|
int rc;
|
||||||
|
|
||||||
params->elem=NULL;
|
// params->elem=NULL;
|
||||||
|
|
||||||
/* try to retrieve a handler for this message element */
|
/* try to retrieve a handler for this message element */
|
||||||
handler = cw_msgset_get_elemhandler(params->msgset,proto, vendor, elem_id);
|
handler = cw_msgset_get_elemhandler(params->msgset,proto, vendor, elem_id);
|
||||||
|
@ -21,149 +21,6 @@
|
|||||||
* @brief implementation of cw_put_msg.
|
* @brief implementation of cw_put_msg.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include "cw.h"
|
|
||||||
|
|
||||||
#include "conn.h"
|
|
||||||
|
|
||||||
#include "log.h"
|
|
||||||
#include "dbg.h"
|
|
||||||
#include "msgset.h"
|
|
||||||
#include "mavltypes.h"
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Put a message to a buffer
|
|
||||||
* This functions assumes, that a message header is
|
|
||||||
* alread initilaized in buffer
|
|
||||||
* Message alements are taken fom actiondef in #conn->action
|
|
||||||
*/
|
|
||||||
int cw_put_msg(struct conn *conn, uint8_t * rawout)
|
|
||||||
{
|
|
||||||
char details[1024];
|
|
||||||
uint8_t *msgptr,*dst;
|
|
||||||
int type;
|
|
||||||
struct cw_MsgData * msg;
|
|
||||||
struct mlistelem * elem;
|
|
||||||
int len,l;
|
|
||||||
|
|
||||||
cw_dbg(DBG_INFO, "Number of elements in ktv: %d",conn->local_cfg->count);
|
|
||||||
/* cw_dbg_ktv_dump(conn->local_cfg,DBG_CFG_DMP,"Local CFG","LOCAL:","End Local CFG");*/
|
|
||||||
|
|
||||||
/* rawout is already initialized, so we can get
|
|
||||||
* msg type from buffer */
|
|
||||||
msgptr = rawout + cw_get_hdr_msg_offset(rawout);
|
|
||||||
type = cw_get_msg_type(msgptr);
|
|
||||||
|
|
||||||
/* look for message data */
|
|
||||||
msg = cw_msgset_get_msgdata(conn->msgset,type);
|
|
||||||
if (msg == NULL){
|
|
||||||
cw_log(LOG_ERR,"Error: Can't create message of type %d (%s) - no definition found.",
|
|
||||||
type, cw_strmsg(type));
|
|
||||||
return CAPWAP_RESULT_MSG_UNRECOGNIZED;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (msg->preprocess){
|
|
||||||
msg->preprocess(conn);
|
|
||||||
}
|
|
||||||
|
|
||||||
cw_dbg(DBG_MSG_ASSEMBLY,"*** Assembling message of type %d (%s) ***",
|
|
||||||
msg->type, msg->name);
|
|
||||||
|
|
||||||
dst = msgptr+8;
|
|
||||||
len =0;
|
|
||||||
mlist_foreach(elem,msg->elements_list){
|
|
||||||
struct cw_ElemData * data;
|
|
||||||
struct cw_ElemHandler * handler;
|
|
||||||
struct cw_ElemHandlerParams params;
|
|
||||||
|
|
||||||
data = mlistelem_dataptr(elem);
|
|
||||||
handler = cw_msgset_get_elemhandler(conn->msgset,data->proto,data->vendor,data->id);
|
|
||||||
printf("Elem: %d %d %d %s\n", data->proto, data->vendor, data->id, handler->name);
|
|
||||||
if (handler==NULL){
|
|
||||||
cw_log(LOG_ERR,"Can't put message element %d %d %d, no handler defined.",
|
|
||||||
data->proto,data->vendor,data->id);
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
if (handler->put == NULL){
|
|
||||||
if (data->mand){
|
|
||||||
cw_log(LOG_ERR,"Error: Can't add mandatory message element %d - %s, no put method defined",
|
|
||||||
handler->id, handler->name);
|
|
||||||
|
|
||||||
}
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* params.conn=conn;*/
|
|
||||||
params.local_cfg=conn->local_cfg;
|
|
||||||
params.remote_cfg=conn->remote_cfg;
|
|
||||||
params.default_cfg=conn->default_cfg;
|
|
||||||
params.global_cfg=conn->global_cfg;
|
|
||||||
params.msgset=conn->msgset;
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
params.elemdata = data;
|
|
||||||
params.elem=NULL;
|
|
||||||
params.msgdata=msg;
|
|
||||||
params.debug_details=details;
|
|
||||||
*details=0;
|
|
||||||
|
|
||||||
if (strcmp(handler->key,"cisco/ap-led-flash-config")==0){
|
|
||||||
printf("flash config\n");
|
|
||||||
/* cisco/ap-led-flash-config/flash-enable */
|
|
||||||
}
|
|
||||||
|
|
||||||
l = handler->put(handler,¶ms,dst+len);
|
|
||||||
|
|
||||||
/* if(l>0)
|
|
||||||
cw_dbg_elem(DBG_ELEM_OUT,conn,type,handler,dst+len,l);
|
|
||||||
* if (strlen(details)){
|
|
||||||
cw_dbg(DBG_ELEM_DETAIL," %s",params.debug_details);
|
|
||||||
}
|
|
||||||
*/ len += l;
|
|
||||||
}
|
|
||||||
|
|
||||||
cw_set_msg_elems_len(msgptr, len);
|
|
||||||
cw_dbg(DBG_MSG_ASSEMBLY,"*** Done assenmbling message of type %d (%s) ***",
|
|
||||||
msg->type, msg->name);
|
|
||||||
if (type & 1) {
|
|
||||||
/* It's a request, so we have to set seqnum */
|
|
||||||
int s = conn_get_next_seqnum(conn);
|
|
||||||
cw_set_msg_seqnum(msgptr,s);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
{
|
|
||||||
printf ("----------------------------------- redecode -----------------------------\n");
|
|
||||||
uint8_t *elems_ptr;
|
|
||||||
|
|
||||||
int offset = cw_get_hdr_msg_offset(rawout);
|
|
||||||
|
|
||||||
uint8_t *msg_ptr = rawout + offset;
|
|
||||||
int elems_len = cw_get_msg_elems_len(msg_ptr);
|
|
||||||
elems_ptr = cw_get_msg_elems_ptr(msg_ptr);
|
|
||||||
mavl_t * cfg = cw_ktv_create();
|
|
||||||
|
|
||||||
struct cw_ElemHandlerParams params;
|
|
||||||
|
|
||||||
params.remote_cfg=cfg;
|
|
||||||
params.msgset=conn->msgset;
|
|
||||||
params.msgdata=msg;
|
|
||||||
|
|
||||||
|
|
||||||
cw_decode_elements( ¶ms, elems_ptr,elems_len);
|
|
||||||
|
|
||||||
printf ("----------------------------------- end redecode -----------------------------\n");
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
return CAPWAP_RESULT_SUCCESS;
|
|
||||||
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Put a message to a buffer
|
* Put a message to a buffer
|
||||||
@ -173,7 +30,7 @@ printf("Elem: %d %d %d %s\n", data->proto, data->vendor, data->id, handler->name
|
|||||||
*/
|
*/
|
||||||
|
|
||||||
|
|
||||||
int cw_put_custom_msg(struct conn *conn, uint8_t * rawout, /*mavl_conststr_t elems*/ int t)
|
int cw_put_custom_msg(struct cw_Conn *conn, uint8_t * rawout, /*mavl_conststr_t elems*/ int t)
|
||||||
{
|
{
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -32,7 +32,7 @@ int cw_read_ac_descriptor(mavl_t store,
|
|||||||
struct cw_DescriptorSubelemDef *allowed)
|
struct cw_DescriptorSubelemDef *allowed)
|
||||||
{
|
{
|
||||||
|
|
||||||
cw_ktv_read_struct(params->remote_cfg,acstatus,eh->key,data,len);
|
CW_TYPE_STRUCT->read(params->cfg,eh->key,data,len,acstatus);
|
||||||
|
|
||||||
if (!allowed)
|
if (!allowed)
|
||||||
allowed=allowed_default;
|
allowed=allowed_default;
|
||||||
|
@ -22,12 +22,12 @@
|
|||||||
#include "keys.h"
|
#include "keys.h"
|
||||||
|
|
||||||
|
|
||||||
int cw_read_descriptor_subelems(mavl_t cfg, const char * parent_key,
|
int cw_read_descriptor_subelems(mavl_t cfg, const char *parent_key,
|
||||||
uint8_t * data, int len,
|
uint8_t * data, int len,
|
||||||
struct cw_DescriptorSubelemDef *elems)
|
struct cw_DescriptorSubelemDef *elems)
|
||||||
{
|
{
|
||||||
uint32_t vendor_id;
|
uint32_t vendor_id;
|
||||||
int sublen,subtype;
|
int sublen, subtype;
|
||||||
int errors = 0;
|
int errors = 0;
|
||||||
int success = 0;
|
int success = 0;
|
||||||
int sub = 0;
|
int sub = 0;
|
||||||
@ -41,18 +41,17 @@ int cw_read_descriptor_subelems(mavl_t cfg, const char * parent_key,
|
|||||||
sublen = cw_get_word(data + sub + 6);
|
sublen = cw_get_word(data + sub + 6);
|
||||||
subtype = cw_get_word(data + sub + 4);
|
subtype = cw_get_word(data + sub + 4);
|
||||||
|
|
||||||
|
|
||||||
/* search sub-element */
|
/* search sub-element */
|
||||||
for (i = 0; elems[i].maxlen; i++) {
|
for (i = 0; elems[i].maxlen; i++) {
|
||||||
|
if (elems[i].type == subtype)
|
||||||
if (elems[i].type == subtype /* && elems[i].vendor_id==vendor_id*/)
|
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
if (!elems[i].maxlen) {
|
if (!elems[i].maxlen) {
|
||||||
cw_dbg_version_subelem(DBG_ELEM_ERR, "Can't handle sub-elem, vendor or type unknown",
|
/* cw_dbg_version_subelem(DBG_ELEM_ERR,
|
||||||
subtype, vendor_id, data+sub+8, sublen);
|
"Can't handle sub-elem, vendor or type unknown",
|
||||||
|
subtype, vendor_id,
|
||||||
|
data + sub + 8, sublen);*/
|
||||||
errors++;
|
errors++;
|
||||||
} else {
|
} else {
|
||||||
int l = sublen;
|
int l = sublen;
|
||||||
@ -69,15 +68,24 @@ int cw_read_descriptor_subelems(mavl_t cfg, const char * parent_key,
|
|||||||
|
|
||||||
|
|
||||||
/* vendor */
|
/* vendor */
|
||||||
sprintf(key,"%s/%s/%s",parent_key,elems[i].key,CW_SKEY_VENDOR);
|
sprintf(key, "%s/%s/%s", parent_key, elems[i].key,
|
||||||
cw_ktv_add(cfg,key,CW_TYPE_DWORD,NULL,data + sub,4);
|
CW_SKEY_VENDOR);
|
||||||
|
cw_cfg_set_int(cfg, key, vendor_id);
|
||||||
|
|
||||||
|
|
||||||
/* version */
|
/* version */
|
||||||
sprintf(key,"%s/%s/%s",parent_key,elems[i].key,CW_SKEY_VERSION);
|
sprintf(key, "%s/%s/%s", parent_key, elems[i].key,
|
||||||
cw_ktv_add(cfg,key,CW_TYPE_BSTR16,NULL,data+sub+8,l);
|
CW_SKEY_VERSION);
|
||||||
|
|
||||||
|
CW_TYPE_BSTR16->read(cfg,key,data+sub+8,l,NULL);
|
||||||
|
|
||||||
|
|
||||||
sprintf(dbgstr, "%s", key);
|
sprintf(dbgstr, "%s", key);
|
||||||
cw_dbg_version_subelem(DBG_SUBELEM, dbgstr, subtype, vendor_id, data+sub+8,l);
|
|
||||||
|
|
||||||
|
|
||||||
|
/* cw_dbg_version_subelem(DBG_SUBELEM, dbgstr, subtype,
|
||||||
|
vendor_id, data + sub + 8, l);*/
|
||||||
success++;
|
success++;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -2,7 +2,7 @@
|
|||||||
#include "log.h"
|
#include "log.h"
|
||||||
|
|
||||||
|
|
||||||
int cw_read_from(struct conn *conn, struct sockaddr_storage *from)
|
int cw_read_from(struct cw_Conn *conn, struct sockaddr_storage *from)
|
||||||
{
|
{
|
||||||
int n;
|
int n;
|
||||||
uint8_t buf[2024];
|
uint8_t buf[2024];
|
||||||
|
@ -1,30 +0,0 @@
|
|||||||
|
|
||||||
#include "capwap.h"
|
|
||||||
#include "val.h"
|
|
||||||
#include "msgset.h"
|
|
||||||
#include "log.h"
|
|
||||||
#include "cw.h"
|
|
||||||
|
|
||||||
|
|
||||||
int cw_in_radio_generic(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params,
|
|
||||||
uint8_t * elem_data, int elem_len)
|
|
||||||
{
|
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
|
||||||
cw_Val_t * result;
|
|
||||||
int radio;
|
|
||||||
|
|
||||||
if (!handler->type){
|
|
||||||
cw_log(LOG_ERR,"Can't handle element: %s, no type defined",handler->name);
|
|
||||||
return CAPWAP_RESULT_UNRECOGNIZED_MESSAGE_ELEMENT;
|
|
||||||
}
|
|
||||||
|
|
||||||
radio=cw_get_byte(elem_data);
|
|
||||||
sprintf(key,"radio.%d/%s",radio,handler->key);
|
|
||||||
|
|
||||||
result = cw_ktv_add(params->remote_cfg, key,
|
|
||||||
handler->type, NULL, elem_data+1,elem_len-1);
|
|
||||||
|
|
||||||
params->elem=result;
|
|
||||||
|
|
||||||
return CAPWAP_RESULT_SUCCESS;
|
|
||||||
}
|
|
@ -16,7 +16,7 @@ static struct cw_DescriptorSubelemDef allowed_default[] = {
|
|||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
int cw_read_wtp_descriptor(mavl_t cfg, struct conn *conn,
|
int cw_read_wtp_descriptor(mavl_t cfg, struct cw_Conn *conn,
|
||||||
struct cw_ElemHandler *eh, uint8_t * data, int len,
|
struct cw_ElemHandler *eh, uint8_t * data, int len,
|
||||||
struct cw_DescriptorSubelemDef *allowed)
|
struct cw_DescriptorSubelemDef *allowed)
|
||||||
{
|
{
|
||||||
@ -38,11 +38,13 @@ int cw_read_wtp_descriptor(mavl_t cfg, struct conn *conn,
|
|||||||
"Non standard conform WTP Descriptor, number of encryptoin elements is 0.");
|
"Non standard conform WTP Descriptor, number of encryptoin elements is 0.");
|
||||||
}
|
}
|
||||||
|
|
||||||
sprintf(key,"%s/%s",eh->key, CW_SKEY_MAX_RADIOS);
|
sprintf(key,"%s/%s",eh->key, "max-radios");
|
||||||
cw_ktv_add(cfg,key,CW_TYPE_BYTE,NULL,data,1);
|
// cw_ktv_add(cfg,key,CW_TYPE_BYTE,NULL,data,1);
|
||||||
|
CW_TYPE_BYTE->read(cfg,key,data,1,eh->param);
|
||||||
|
|
||||||
sprintf(key,"%s/%s",eh->key, CW_SKEY_RADIOS_IN_USE);
|
sprintf(key,"%s/%s",eh->key, CW_SKEY_RADIOS_IN_USE);
|
||||||
cw_ktv_add(cfg,key,CW_TYPE_BYTE,NULL,data+1,1);
|
// cw_ktv_add(cfg,key,CW_TYPE_BYTE,NULL,data+1,1);
|
||||||
|
CW_TYPE_BYTE->read(cfg,key,data,1,eh->param);
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
@ -20,7 +20,7 @@ static struct cw_DescriptorSubelemDef allowed_default[] = {
|
|||||||
/**
|
/**
|
||||||
* Read WTP Descriptor in Cisco-Style (Draft 7)
|
* Read WTP Descriptor in Cisco-Style (Draft 7)
|
||||||
*/
|
*/
|
||||||
int cw_read_wtp_descriptor_7(mavl_t cfg, struct conn *conn,
|
int cw_read_wtp_descriptor_7(mavl_t cfg, struct cw_Conn *conn,
|
||||||
struct cw_ElemHandler *eh, uint8_t * data, int len,
|
struct cw_ElemHandler *eh, uint8_t * data, int len,
|
||||||
struct cw_DescriptorSubelemDef *allowed)
|
struct cw_DescriptorSubelemDef *allowed)
|
||||||
{
|
{
|
||||||
@ -29,12 +29,11 @@ int cw_read_wtp_descriptor_7(mavl_t cfg, struct conn *conn,
|
|||||||
int pos;
|
int pos;
|
||||||
char key[64];
|
char key[64];
|
||||||
|
|
||||||
sprintf(key,"%s/%s",eh->key, CW_SKEY_MAX_RADIOS);
|
sprintf(key,"%s/%s",eh->key, "max-radios");
|
||||||
cw_ktv_add(cfg,key,CW_TYPE_BYTE,NULL,data,1);
|
cw_cfg_set_int(cfg,key,cw_get_byte(data));
|
||||||
|
|
||||||
sprintf(key,"%s/%s",eh->key, CW_SKEY_RADIOS_IN_USE);
|
sprintf(key,"%s/%s",eh->key, CW_SKEY_RADIOS_IN_USE);
|
||||||
cw_ktv_add(cfg,key,CW_TYPE_BYTE,NULL,data+1,1);
|
cw_cfg_set_int(cfg,key,cw_get_byte(data+1));
|
||||||
|
|
||||||
|
|
||||||
pos = 2;
|
pos = 2;
|
||||||
|
|
||||||
|
@ -1,15 +1,18 @@
|
|||||||
#include "cw.h"
|
#include "cw.h"
|
||||||
|
#include "cfg.h"
|
||||||
|
#include "dbg.h"
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
static int get_psk(struct conn * conn,const char * username, uint8_t **psk, unsigned int *len)
|
static int get_psk(struct cw_Conn *conn, const char *username, uint8_t ** psk,
|
||||||
|
unsigned int *len)
|
||||||
{
|
{
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
cw_Val_t * result;
|
cw_Val_t *result;
|
||||||
sprintf(key,"%s/%s","psk",username);
|
sprintf(key, "%s/%s", "psk", username);
|
||||||
result = cw_ktv_get(conn->local_cfg,key,CW_TYPE_BSTR16);
|
result = cw_ktv_get(conn->local_cfg, key, CW_TYPE_BSTR16);
|
||||||
if (result == NULL){
|
if (result == NULL) {
|
||||||
if (conn->dtls_psk != NULL){
|
if (conn->dtls_psk != NULL) {
|
||||||
*psk = bstr16_data(conn->dtls_psk);
|
*psk = bstr16_data(conn->dtls_psk);
|
||||||
*len = bstr16_len(conn->dtls_psk);
|
*len = bstr16_len(conn->dtls_psk);
|
||||||
return 1;
|
return 1;
|
||||||
@ -33,47 +36,46 @@ static int get_psk(struct conn * conn,const char * username, uint8_t **psk, unsi
|
|||||||
* @param default_cipher
|
* @param default_cipher
|
||||||
* @return
|
* @return
|
||||||
*/
|
*/
|
||||||
int cw_setup_dtls(struct conn * conn, mavl_t cfg, const char *prefix, char * default_cipher)
|
int cw_setup_dtls(struct cw_Conn *conn, cw_Cfg_t * cfg, const char *prefix,
|
||||||
|
char *default_cipher)
|
||||||
{
|
{
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
char *ssl_cert,*ssl_key;
|
const char *ssl_cert, *ssl_key;
|
||||||
uint8_t security;
|
uint8_t security;
|
||||||
|
|
||||||
security = 0;
|
security = 0;
|
||||||
|
|
||||||
sprintf(key,"%s/%s",prefix,"ssl-cipher");
|
sprintf(key, "%s/%s", prefix, "ssl-cipher");
|
||||||
conn->dtls_cipher = cw_ktv_get_str(cfg,key, default_cipher);
|
conn->dtls_cipher = cw_cfg_get(cfg, key, default_cipher);
|
||||||
|
|
||||||
|
sprintf(key, "%s/%s", prefix, "ssl-psk");
|
||||||
|
conn->dtls_psk = cw_cfg_get(cfg, key, NULL);
|
||||||
|
|
||||||
sprintf(key,"%s/%s",prefix,"ssl-psk");
|
sprintf(key, "%s/%s", prefix, "ssl-psk-enable");
|
||||||
conn->dtls_psk = cw_ktv_get_bstr16(cfg,key,NULL);
|
conn->dtls_psk_enable = cw_cfg_get_bool(cfg, key, "flase");
|
||||||
|
|
||||||
sprintf(key,"%s/%s",prefix,"ssl-psk-enable");
|
if (conn->dtls_psk_enable) {
|
||||||
conn->dtls_psk_enable = cw_ktv_get_bool(cfg,key,0);
|
|
||||||
|
|
||||||
if (conn->dtls_psk_enable ){
|
|
||||||
security |= CAPWAP_FLAG_AC_SECURITY_S;
|
security |= CAPWAP_FLAG_AC_SECURITY_S;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
sprintf(key,"%s/%s",prefix,"ssl-certfile");
|
sprintf(key, "%s/%s", prefix, "ssl-certfile");
|
||||||
ssl_cert = cw_ktv_get_str(conn->local_cfg,key,NULL);
|
ssl_cert = cw_cfg_get(cfg, key, NULL);
|
||||||
sprintf(key,"%s/%s",prefix,"ssl-keyfile");
|
sprintf(key, "%s/%s", prefix, "ssl-keyfile");
|
||||||
ssl_key = cw_ktv_get_str(conn->local_cfg,key,NULL);
|
ssl_key = cw_cfg_get(cfg, key, NULL);
|
||||||
|
|
||||||
if (ssl_cert != NULL && ssl_key != NULL){
|
if (ssl_cert != NULL && ssl_key != NULL) {
|
||||||
conn->dtls_cert_file = ssl_cert;
|
conn->dtls_cert_file = ssl_cert;
|
||||||
conn->dtls_key_file = ssl_key;
|
conn->dtls_key_file = ssl_key;
|
||||||
sprintf(key,"%s/%s",prefix,"ssl-keypass");
|
sprintf(key, "%s/%s", prefix, "ssl-keypass");
|
||||||
conn->dtls_key_pass = cw_ktv_get_str(cfg,key,NULL);
|
conn->dtls_key_pass = cw_cfg_get(cfg, key, NULL);
|
||||||
security |= CAPWAP_FLAG_AC_SECURITY_X;
|
security |= CAPWAP_FLAG_AC_SECURITY_X;
|
||||||
}
|
}
|
||||||
|
|
||||||
sprintf(key,"%s/%s",prefix,"ssl-dhbits");
|
sprintf(key, "%s/%s", prefix, "ssl-dhbits");
|
||||||
conn->dtls_dhbits = cw_ktv_get_word(cfg,key,1024);
|
conn->dtls_dhbits = cw_cfg_get_word(cfg, key, 1024);
|
||||||
|
|
||||||
conn->dtls_get_psk = get_psk;
|
conn->dtls_get_psk = get_psk;
|
||||||
|
|
||||||
return security;
|
return security;
|
||||||
}
|
}
|
||||||
|
@ -84,6 +84,30 @@ static const char * get_type_name(cw_Val_t *data)
|
|||||||
return CW_TYPE_BOOL->name;
|
return CW_TYPE_BOOL->name;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static int bread(cw_Cfg_t *cfg, const char * key, const uint8_t *src, int len, const void *param)
|
||||||
|
{
|
||||||
|
cw_Val_t val;
|
||||||
|
int l;
|
||||||
|
char str[2048];
|
||||||
|
memset(&val,0,sizeof(cw_Val_t));
|
||||||
|
val.valguard = param;
|
||||||
|
get(&val,src,len);
|
||||||
|
to_str(&val,str,2048);
|
||||||
|
cw_cfg_set(cfg,key,str);
|
||||||
|
l = val.type->len(&val);
|
||||||
|
if (val.type->del)
|
||||||
|
val.type->del(&val);
|
||||||
|
return l;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int bwrite(cw_Cfg_t ** cfgs, const char *key, uint8_t *dst, const void * param)
|
||||||
|
{
|
||||||
|
return cw_generic_write_l(cfgs,CW_TYPE_BOOL,key,dst,param);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
const struct cw_Type cw_type_bool = {
|
const struct cw_Type cw_type_bool = {
|
||||||
"Bool", /* name */
|
"Bool", /* name */
|
||||||
NULL, /* del */
|
NULL, /* del */
|
||||||
@ -93,5 +117,8 @@ const struct cw_Type cw_type_bool = {
|
|||||||
from_str, /* from_str */
|
from_str, /* from_str */
|
||||||
len, /* len */
|
len, /* len */
|
||||||
data, /* data */
|
data, /* data */
|
||||||
get_type_name /* get_type_name */
|
get_type_name, /* get_type_name */
|
||||||
|
NULL,
|
||||||
|
bread,
|
||||||
|
bwrite
|
||||||
};
|
};
|
||||||
|
@ -21,6 +21,7 @@
|
|||||||
#include "format.h"
|
#include "format.h"
|
||||||
#include "cw.h"
|
#include "cw.h"
|
||||||
#include "val.h"
|
#include "val.h"
|
||||||
|
#include "dbg.h"
|
||||||
|
|
||||||
|
|
||||||
static void del ( struct cw_Val * data )
|
static void del ( struct cw_Val * data )
|
||||||
@ -104,6 +105,75 @@ static int cast(cw_Val_t * data)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int bread(cw_Cfg_t *cfg, const char * key, const uint8_t *src, int len, const void *param)
|
||||||
|
{
|
||||||
|
char *d, *dst;
|
||||||
|
dst = malloc(len*2+3);
|
||||||
|
if (dst==NULL)
|
||||||
|
return 0;
|
||||||
|
d=dst;
|
||||||
|
|
||||||
|
if ( format_is_utf8 ( src, len) ) {
|
||||||
|
d += sprintf ( d, "%.*s", len, src );
|
||||||
|
|
||||||
|
} else {
|
||||||
|
d += sprintf ( d, ".x" );
|
||||||
|
d += format_hex ( d, src,len);
|
||||||
|
}
|
||||||
|
|
||||||
|
cw_cfg_set(cfg,key,dst);
|
||||||
|
free(dst);
|
||||||
|
return d - dst;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
static int xput(uint8_t * dst,const char *s)
|
||||||
|
{
|
||||||
|
int msize;
|
||||||
|
int l;
|
||||||
|
l = strlen(s);
|
||||||
|
if (s[0]!='.'){
|
||||||
|
memcpy(dst,(uint8_t*)s,l);
|
||||||
|
return l;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (l<=2){
|
||||||
|
memcpy(dst,(uint8_t*)s,l);
|
||||||
|
return l;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (s[1]=='.'){
|
||||||
|
memcpy(dst,(uint8_t*)s+1,l-1);
|
||||||
|
return l-1;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (s[1]!='x'){
|
||||||
|
memcpy(dst,(uint8_t*)s,l);
|
||||||
|
return l;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* the string starts with ".x" - read hexbytes */
|
||||||
|
l-=2;
|
||||||
|
msize=l/2;
|
||||||
|
if(l&1)
|
||||||
|
msize++;
|
||||||
|
cw_format_scan_hex_bytes(dst,s+2,l);
|
||||||
|
return msize;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
static int bwrite(cw_Cfg_t **cfg, const char *key, uint8_t *dst, const void * param)
|
||||||
|
{
|
||||||
|
const char *s;
|
||||||
|
|
||||||
|
s = cw_cfg_get_l(cfg,key,NULL);
|
||||||
|
if (s==NULL)
|
||||||
|
return -1;
|
||||||
|
return xput(dst,s);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
const struct cw_Type cw_type_bstr16 = {
|
const struct cw_Type cw_type_bstr16 = {
|
||||||
"Bstr16", /* name */
|
"Bstr16", /* name */
|
||||||
@ -115,7 +185,10 @@ const struct cw_Type cw_type_bstr16 = {
|
|||||||
len, /* len */
|
len, /* len */
|
||||||
data, /* data */
|
data, /* data */
|
||||||
get_type_name, /* get_type_name */
|
get_type_name, /* get_type_name */
|
||||||
cast /* cast */
|
cast, /* cast */
|
||||||
|
bread,
|
||||||
|
bwrite
|
||||||
|
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
|
@ -35,6 +35,9 @@ static int put(const cw_Val_t *data, uint8_t * dst)
|
|||||||
|
|
||||||
static const char * get_guardstr(int val, const cw_ValValRange_t * valrange)
|
static const char * get_guardstr(int val, const cw_ValValRange_t * valrange)
|
||||||
{
|
{
|
||||||
|
if (valrange==NULL)
|
||||||
|
return NULL;
|
||||||
|
|
||||||
while(valrange->name!=NULL){
|
while(valrange->name!=NULL){
|
||||||
if(val>=valrange->min && val<=valrange->max)
|
if(val>=valrange->min && val<=valrange->max)
|
||||||
return valrange->name;
|
return valrange->name;
|
||||||
@ -121,6 +124,26 @@ static int cast(cw_Val_t * data)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int bread(cw_Cfg_t *cfg, const char * key, const uint8_t *src, int len, const void *param)
|
||||||
|
{
|
||||||
|
uint8_t val;
|
||||||
|
cw_ValValRange_t * valrange = (cw_ValValRange_t *) param;
|
||||||
|
const char *str;
|
||||||
|
|
||||||
|
val = cw_get_byte(src);
|
||||||
|
str = get_guardstr(val, valrange);
|
||||||
|
if (str != NULL)
|
||||||
|
cw_cfg_set(cfg,key,str);
|
||||||
|
else
|
||||||
|
cw_cfg_set_int(cfg,key,val);
|
||||||
|
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int bwrite(cw_Cfg_t ** cfgs, const char *key, uint8_t *dst, const void * param)
|
||||||
|
{
|
||||||
|
return cw_generic_write_l(cfgs,CW_TYPE_BYTE,key,dst,param);
|
||||||
|
}
|
||||||
|
|
||||||
const struct cw_Type cw_type_byte = {
|
const struct cw_Type cw_type_byte = {
|
||||||
"Byte", /* name */
|
"Byte", /* name */
|
||||||
@ -132,5 +155,8 @@ const struct cw_Type cw_type_byte = {
|
|||||||
len, /* len */
|
len, /* len */
|
||||||
data, /* data */
|
data, /* data */
|
||||||
get_type_name, /* get_type_name */
|
get_type_name, /* get_type_name */
|
||||||
cast
|
cast,
|
||||||
|
bread,
|
||||||
|
bwrite
|
||||||
|
|
||||||
};
|
};
|
||||||
|
@ -66,6 +66,45 @@ static int cast(cw_Val_t * data)
|
|||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static int bread(cw_Cfg_t *cfg, const char * key, const uint8_t *src, int len, const void *param)
|
||||||
|
{
|
||||||
|
|
||||||
|
|
||||||
|
uint32_t val;
|
||||||
|
//cw_ValValRange_t * valrange = (cw_ValValRange_t *) param;
|
||||||
|
//const char *str;
|
||||||
|
|
||||||
|
val = cw_get_dword(src);
|
||||||
|
/* str = get_guardstr(val, valrange);
|
||||||
|
if (str != NULL)
|
||||||
|
cw_cfg_set(cfg,key,str);
|
||||||
|
else*/
|
||||||
|
cw_cfg_set_int(cfg,key,val);
|
||||||
|
|
||||||
|
return 4;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static int bwrite(cw_Cfg_t **cfgs, const char *key, uint8_t *dst, const void * param)
|
||||||
|
{
|
||||||
|
return cw_generic_write_l(cfgs,CW_TYPE_DWORD,key,dst,param);
|
||||||
|
|
||||||
|
/* cw_Val_t val;
|
||||||
|
int l;
|
||||||
|
const char *s;
|
||||||
|
memset(&val,0,sizeof(cw_Val_t));
|
||||||
|
val.valguard=param;
|
||||||
|
s = cw_cfg_get(cfg,key,NULL);
|
||||||
|
if (s==NULL)
|
||||||
|
return -1;
|
||||||
|
from_str(&val,s);
|
||||||
|
l = put(&val,dst);
|
||||||
|
if(val.type->del)
|
||||||
|
val.type->del(&val);
|
||||||
|
return l;*/
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
const struct cw_Type cw_type_dword = {
|
const struct cw_Type cw_type_dword = {
|
||||||
"Dword", /* name */
|
"Dword", /* name */
|
||||||
NULL, /* del */
|
NULL, /* del */
|
||||||
@ -76,6 +115,8 @@ const struct cw_Type cw_type_dword = {
|
|||||||
NULL, /* len */
|
NULL, /* len */
|
||||||
NULL, /* data */
|
NULL, /* data */
|
||||||
get_type_name, /* get_type_name */
|
get_type_name, /* get_type_name */
|
||||||
cast
|
cast,
|
||||||
|
bread,
|
||||||
|
bwrite
|
||||||
};
|
};
|
||||||
|
|
||||||
|
@ -111,6 +111,29 @@ static const char * get_type_name(cw_Val_t *data)
|
|||||||
return CW_TYPE_IPADDRESS->name;
|
return CW_TYPE_IPADDRESS->name;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
static int bread(cw_Cfg_t *cfg, const char * key, const uint8_t *src, int len, const void *param)
|
||||||
|
{
|
||||||
|
char str[128];
|
||||||
|
int rc;
|
||||||
|
cw_Val_t val;
|
||||||
|
memset(&val,0,sizeof(cw_Val_t));
|
||||||
|
get(&val,src,len);
|
||||||
|
to_str(&val,str,128);
|
||||||
|
cw_cfg_set(cfg,key,str);
|
||||||
|
rc = val.type->len(&val);
|
||||||
|
del(&val);
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int bwrite(cw_Cfg_t ** cfgs, const char *key, uint8_t *dst, const void * param)
|
||||||
|
{
|
||||||
|
return cw_generic_write_l(cfgs,CW_TYPE_IPADDRESS,key,dst,param);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
const struct cw_Type cw_type_ipaddress = {
|
const struct cw_Type cw_type_ipaddress = {
|
||||||
"IPAddress", /* name */
|
"IPAddress", /* name */
|
||||||
del, /* del */
|
del, /* del */
|
||||||
@ -120,7 +143,11 @@ const struct cw_Type cw_type_ipaddress = {
|
|||||||
from_str, /* from_str */
|
from_str, /* from_str */
|
||||||
len, /* len */
|
len, /* len */
|
||||||
data, /* data */
|
data, /* data */
|
||||||
get_type_name
|
get_type_name,
|
||||||
|
NULL,
|
||||||
|
bread,
|
||||||
|
bwrite,
|
||||||
|
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
|
@ -90,6 +90,25 @@ static const char * get_type_name(cw_Val_t *data)
|
|||||||
return CW_TYPE_STR->name;
|
return CW_TYPE_STR->name;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int bread(cw_Cfg_t *cfg, const char * key, const uint8_t *src, int len, const void *param)
|
||||||
|
{
|
||||||
|
cw_Val_t val;
|
||||||
|
int l;
|
||||||
|
char str[2048];
|
||||||
|
memset(&val,0,sizeof(cw_Val_t));
|
||||||
|
val.valguard = param;
|
||||||
|
get(&val,src,len);
|
||||||
|
to_str(&val,str,2048);
|
||||||
|
cw_cfg_set(cfg,key,str);
|
||||||
|
l = val.type->len(&val);
|
||||||
|
del(&val);
|
||||||
|
return l;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int bwrite(cw_Cfg_t ** cfgs, const char *key, uint8_t *dst, const void * param)
|
||||||
|
{
|
||||||
|
return cw_generic_write_l(cfgs,CW_TYPE_STR,key,dst,param);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
const struct cw_Type cw_type_str = {
|
const struct cw_Type cw_type_str = {
|
||||||
@ -101,5 +120,11 @@ const struct cw_Type cw_type_str = {
|
|||||||
from_str, /* from_str */
|
from_str, /* from_str */
|
||||||
len, /* len */
|
len, /* len */
|
||||||
NULL, /* data */
|
NULL, /* data */
|
||||||
get_type_name /* get_type_name */
|
get_type_name, /* get_type_name */
|
||||||
|
NULL,
|
||||||
|
bread,
|
||||||
|
bwrite,
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
};
|
};
|
||||||
|
200
src/cw/cw_type_struct.c
Normal file
200
src/cw/cw_type_struct.c
Normal file
@ -0,0 +1,200 @@
|
|||||||
|
#include "cw.h"
|
||||||
|
#include "val.h"
|
||||||
|
#include "dbg.h"
|
||||||
|
#include "log.h"
|
||||||
|
|
||||||
|
|
||||||
|
static int read_struct(cw_Cfg_t * cfg,const cw_ValStruct_t * stru, const char *pkey,
|
||||||
|
const uint8_t * data, int len)
|
||||||
|
{
|
||||||
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
|
int pos, i,l;
|
||||||
|
|
||||||
|
|
||||||
|
pos=0; i=0;
|
||||||
|
while (stru[i].type != NULL){
|
||||||
|
if(stru[i].position!=-1)
|
||||||
|
pos=stru[i].position;
|
||||||
|
|
||||||
|
if (stru[i].key!=NULL)
|
||||||
|
sprintf(key,"%s/%s",pkey,stru[i].key);
|
||||||
|
else
|
||||||
|
sprintf(key,"%s",pkey);
|
||||||
|
|
||||||
|
switch (stru[i].len){
|
||||||
|
case CW_STRUCT_LEN_BYTE:
|
||||||
|
/* read len from next byte */
|
||||||
|
l = cw_get_byte(data+pos);
|
||||||
|
pos ++;
|
||||||
|
break;
|
||||||
|
case CW_STRUCT_LEN_WORD:
|
||||||
|
/* read len from next word */
|
||||||
|
l = cw_get_word(data+pos);
|
||||||
|
pos ++;
|
||||||
|
break;
|
||||||
|
case -1:
|
||||||
|
l = len-pos;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
l = stru[i].len;
|
||||||
|
if (pos+l > len){
|
||||||
|
l = len-pos;
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
l=stru[i].type->read(cfg,key,data+pos,l,stru[i].valguard);
|
||||||
|
|
||||||
|
|
||||||
|
// printf("READ STRUCT (%d): %s: %s\n",pos,key,dbstr);
|
||||||
|
|
||||||
|
if (stru[i].len==-1){
|
||||||
|
///l = result->type->len(result);
|
||||||
|
}
|
||||||
|
else {
|
||||||
|
l = stru[i].len;
|
||||||
|
}
|
||||||
|
|
||||||
|
if(stru[i].position == -1)
|
||||||
|
pos+=l;
|
||||||
|
|
||||||
|
i++;
|
||||||
|
}
|
||||||
|
|
||||||
|
return pos;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static int bread(cw_Cfg_t *cfg, const char * key, const uint8_t *src, int len, const void *param)
|
||||||
|
{
|
||||||
|
cw_ValStruct_t * stru = (cw_ValStruct_t *) param;
|
||||||
|
|
||||||
|
read_struct(cfg,stru,key,src,len);
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static int write_struct(cw_Cfg_t ** cfgs, const cw_ValStruct_t * stru, const char *pkey,
|
||||||
|
uint8_t * dst)
|
||||||
|
{
|
||||||
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
|
int pos, i;
|
||||||
|
const char * result;
|
||||||
|
int wrlen;
|
||||||
|
|
||||||
|
cw_Val_t val;
|
||||||
|
memset(&val,0,sizeof(cw_Val_t));
|
||||||
|
|
||||||
|
pos=0; i=0;
|
||||||
|
for(i=0; stru[i].type != NULL;i++){
|
||||||
|
|
||||||
|
if (stru[i].position!=-1){
|
||||||
|
pos=stru[i].position;
|
||||||
|
}
|
||||||
|
if (stru[i].len!=-1)
|
||||||
|
memset(dst+pos,0,stru[i].len);
|
||||||
|
|
||||||
|
|
||||||
|
if (stru[i].key!=NULL)
|
||||||
|
sprintf(key,"%s/%s",pkey,stru[i].key);
|
||||||
|
else
|
||||||
|
sprintf(key,"%s",pkey);
|
||||||
|
|
||||||
|
result = cw_cfg_get_l(cfgs,key,NULL);
|
||||||
|
if(result) {
|
||||||
|
// char s[2048];
|
||||||
|
// result->type->to_str(result,s,2048);
|
||||||
|
// printf("Content: '%s'\n",s);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
if (result == NULL){
|
||||||
|
cw_log(LOG_ERR,"Can't put %s, no value found, filling wth zeros.",key);
|
||||||
|
memset(dst+pos,0,stru[i].len);
|
||||||
|
}
|
||||||
|
else{
|
||||||
|
struct cw_Type * type;
|
||||||
|
type = (struct cw_Type *)stru[i].type;
|
||||||
|
wrlen = type->write(cfgs,key,dst+pos,stru[i].valguard);
|
||||||
|
|
||||||
|
|
||||||
|
/* result->valguard=stru[i].valguard;
|
||||||
|
if (cw_ktv_cast(result,stru[i].type)==NULL){
|
||||||
|
cw_log(LOG_ERR,"Can't cast key '%s' from %s to %s",key,result->type->name,stru[i].type->name);
|
||||||
|
}
|
||||||
|
|
||||||
|
result->type->put(result,dst+pos);*/
|
||||||
|
}
|
||||||
|
if (stru[i].len!=-1)
|
||||||
|
pos+=stru[i].len;
|
||||||
|
else
|
||||||
|
pos+=wrlen; //result->type->len(result);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
return pos;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
static int bwrite(cw_Cfg_t **cfgs, const char *key, uint8_t *dst, const void * param)
|
||||||
|
{
|
||||||
|
return write_struct(cfgs,param,key,dst);
|
||||||
|
|
||||||
|
stop();
|
||||||
|
|
||||||
|
/*
|
||||||
|
int start;
|
||||||
|
int len;
|
||||||
|
cw_Val_t search;
|
||||||
|
const char *result;
|
||||||
|
|
||||||
|
if (!handler->type){
|
||||||
|
cw_log(LOG_ERR,"Can't handle element: %s, no type defined",handler->name);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
search.key = (char*)handler->key;
|
||||||
|
result = mavl_get_first(params->cfg,&search);
|
||||||
|
if (result == NULL ){
|
||||||
|
if (params->elemdata->mand)
|
||||||
|
cw_log(LOG_ERR,"Can't put mandatory message element %s, no data available",handler->name);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (strncmp(result->key,handler->key, strlen(handler->key))!=0){
|
||||||
|
if (params->elemdata->mand)
|
||||||
|
cw_log(LOG_ERR,"Can't put mandatory message element %s, no data available",handler->name);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
start = params->msgset->header_len(handler);
|
||||||
|
|
||||||
|
len = cw_ktv_write_struct(params->cfg,
|
||||||
|
params->cfg,
|
||||||
|
handler->type,handler->key,dst+start);
|
||||||
|
|
||||||
|
return params->msgset->write_header(handler,dst,len);
|
||||||
|
*/
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
const struct cw_Type cw_type_struct = {
|
||||||
|
"Struct", /* name */
|
||||||
|
NULL, /* del */
|
||||||
|
NULL, /* put */
|
||||||
|
NULL, /* get */
|
||||||
|
NULL, /* to_str */
|
||||||
|
NULL, /* from_str */
|
||||||
|
NULL, /* len */
|
||||||
|
NULL, /* data */
|
||||||
|
NULL, /* get_type_name */
|
||||||
|
NULL,
|
||||||
|
bread,
|
||||||
|
bwrite
|
||||||
|
|
||||||
|
};
|
@ -63,6 +63,41 @@ static int cast(cw_Val_t * data)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int bread(cw_Cfg_t *cfg, const char * key, const uint8_t *src, int len, const void *param)
|
||||||
|
{
|
||||||
|
uint16_t val;
|
||||||
|
//cw_ValValRange_t * valrange = (cw_ValValRange_t *) param;
|
||||||
|
//const char *str;
|
||||||
|
|
||||||
|
val = cw_get_word(src);
|
||||||
|
/* str = get_guardstr(val, valrange);
|
||||||
|
if (str != NULL)
|
||||||
|
cw_cfg_set(cfg,key,str);
|
||||||
|
else*/
|
||||||
|
cw_cfg_set_int(cfg,key,val);
|
||||||
|
|
||||||
|
return 2;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int bwrite(cw_Cfg_t **cfgs, const char *key, uint8_t *dst, const void * param)
|
||||||
|
{
|
||||||
|
return cw_generic_write_l(cfgs,CW_TYPE_WORD,key,dst,param);
|
||||||
|
|
||||||
|
/* cw_Val_t val;
|
||||||
|
int l;
|
||||||
|
const char *s;
|
||||||
|
memset(&val,0,sizeof(cw_Val_t));
|
||||||
|
val.valguard=param;
|
||||||
|
s = cw_cfg_get_l(cfg,key,NULL);
|
||||||
|
if (s==NULL)
|
||||||
|
return -1;
|
||||||
|
from_str(&val,s);
|
||||||
|
l = put(&val,dst);
|
||||||
|
if(val.type->del)
|
||||||
|
val.type->del(&val);
|
||||||
|
return l;*/
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
const struct cw_Type cw_type_word = {
|
const struct cw_Type cw_type_word = {
|
||||||
"Word", /* name */
|
"Word", /* name */
|
||||||
@ -74,7 +109,9 @@ const struct cw_Type cw_type_word = {
|
|||||||
NULL,
|
NULL,
|
||||||
NULL,
|
NULL,
|
||||||
get_type_name,
|
get_type_name,
|
||||||
cast
|
cast,
|
||||||
|
bread,
|
||||||
|
bwrite,
|
||||||
|
|
||||||
};
|
};
|
||||||
|
|
||||||
|
@ -3,12 +3,16 @@
|
|||||||
#include "log.h"
|
#include "log.h"
|
||||||
#include "cw.h"
|
#include "cw.h"
|
||||||
#include "dbg.h"
|
#include "dbg.h"
|
||||||
|
#include "cfg.h"
|
||||||
|
|
||||||
int cw_write_descriptor_subelem (uint8_t *dst, mavl_t ktvstore,
|
int cw_write_descriptor_subelem (uint8_t *dst, cw_Cfg_t ** cfg_list,
|
||||||
int subelem_id, const char * parent_key )
|
int subelem_id, const char * parent_key )
|
||||||
{
|
{
|
||||||
char key[256];
|
char key[256];
|
||||||
cw_Val_t * vendor, *version ;
|
uint32_t vendor;
|
||||||
|
//bstr16_t version;
|
||||||
|
const char *vendor_s;
|
||||||
|
|
||||||
uint8_t *d;
|
uint8_t *d;
|
||||||
|
|
||||||
|
|
||||||
@ -17,18 +21,24 @@ int cw_write_descriptor_subelem (uint8_t *dst, mavl_t ktvstore,
|
|||||||
d += cw_put_data(d, bstrv_data(v), bstrv_len(v));
|
d += cw_put_data(d, bstrv_data(v), bstrv_len(v));
|
||||||
*/
|
*/
|
||||||
sprintf (key, "%s/%s", parent_key, CW_SKEY_VENDOR);
|
sprintf (key, "%s/%s", parent_key, CW_SKEY_VENDOR);
|
||||||
vendor = cw_ktv_get (ktvstore, key, CW_TYPE_DWORD);
|
vendor_s = cw_cfg_get_l (cfg_list, key, NULL);
|
||||||
|
|
||||||
if (vendor == NULL) {
|
if (vendor_s == NULL) {
|
||||||
cw_log (LOG_ERR, "Can't put subelem %s, no value of type Dword found.", key);
|
cw_log (LOG_ERR, "Can't put subelem %s, no value of type Dword found.", key);
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
vendor = atoi(vendor_s);
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
sprintf (key, "%s/%s", parent_key, CW_SKEY_VERSION);
|
sprintf (key, "%s/%s", parent_key, CW_SKEY_VERSION);
|
||||||
version = cw_ktv_get (ktvstore, key, CW_TYPE_BSTR16);
|
cw_Val_t * val = cw_cfg_get_val_l(cfg_list, key, CW_TYPE_BSTR16);
|
||||||
|
|
||||||
if (version == NULL) {
|
//version = cw_cfg_get_bstr16 (cfg, key, NULL);
|
||||||
|
|
||||||
|
|
||||||
|
if (val == NULL) {
|
||||||
cw_log (LOG_ERR, "Can't put subelem %s, no value of type Bstr16 found.", key);
|
cw_log (LOG_ERR, "Can't put subelem %s, no value of type Bstr16 found.", key);
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
@ -36,12 +46,17 @@ int cw_write_descriptor_subelem (uint8_t *dst, mavl_t ktvstore,
|
|||||||
d = dst;
|
d = dst;
|
||||||
|
|
||||||
/* put vendor */
|
/* put vendor */
|
||||||
d += vendor->type->put (vendor, d);
|
d += cw_put_dword(d, vendor); //->type->put (vendor, d);
|
||||||
|
|
||||||
/* put version */
|
/* put version */
|
||||||
|
|
||||||
d += cw_put_dword (d, (subelem_id << 16) | version->type->len(version));
|
d += cw_put_dword (d, (subelem_id << 16) | val->type->len(val));
|
||||||
d += version->type->put(version,d);
|
// d += cw_put_bstr16(d, version);
|
||||||
|
d += val->type->put(val,d);
|
||||||
|
|
||||||
|
cw_val_destroy(val);
|
||||||
|
|
||||||
|
// free(version);
|
||||||
|
|
||||||
return d-dst;
|
return d-dst;
|
||||||
}
|
}
|
||||||
|
@ -1,20 +0,0 @@
|
|||||||
#include "conn.h"
|
|
||||||
#include "msgset.h"
|
|
||||||
#include "cw.h"
|
|
||||||
|
|
||||||
int cw_write_header(struct cw_ElemHandler * handler, uint8_t * dst, int len)
|
|
||||||
{
|
|
||||||
if (handler->vendor)
|
|
||||||
return len + cw_put_elem_vendor_hdr(dst, handler->vendor, handler->id, len);
|
|
||||||
|
|
||||||
return len + cw_put_elem_hdr(dst, handler->id, len);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
int cw_header_len(struct cw_ElemHandler * handler)
|
|
||||||
{
|
|
||||||
return handler->vendor ? 10 : 4;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
@ -1,10 +1,14 @@
|
|||||||
#include "cw.h"
|
#include "cw.h"
|
||||||
|
#include "dbg.h"
|
||||||
|
#include "log.h"
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
int cw_write_radio_element(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params, int idx
|
int cw_write_radio_element(struct cw_ElemHandler * handler, struct cw_ElemHandlerParams * params, int idx
|
||||||
, uint8_t * dst)
|
, uint8_t * dst)
|
||||||
{
|
{
|
||||||
char key[CW_KTV_MAX_KEY_LEN];
|
|
||||||
|
char key[CW_CFG_MAX_KEY_LEN];
|
||||||
cw_Val_t *elem, search;
|
cw_Val_t *elem, search;
|
||||||
int len;
|
int len;
|
||||||
uint8_t * d;
|
uint8_t * d;
|
||||||
@ -12,32 +16,58 @@ int cw_write_radio_element(struct cw_ElemHandler * handler, struct cw_ElemHandle
|
|||||||
len =0;
|
len =0;
|
||||||
sprintf(key,"radio.%d/%s",idx,handler->key);
|
sprintf(key,"radio.%d/%s",idx,handler->key);
|
||||||
|
|
||||||
printf("Looking for readio key: %s\n",key);
|
// printf("Looking for readio key: %s\n",key);
|
||||||
|
|
||||||
search.key=key;
|
// search.key=key;
|
||||||
elem = mavl_get(params->local_cfg, &search);
|
// elem = mavl_get(params->cfg, &search);
|
||||||
|
// elem = cw_cfg_get_val_l(params->cfg_list, key, handler->type);
|
||||||
|
|
||||||
if (elem==NULL){
|
|
||||||
printf("Nothing found\n");
|
// if (elem==NULL){
|
||||||
return 0;
|
// printf("Nothing found\n");
|
||||||
}
|
// return 0;
|
||||||
|
// }
|
||||||
|
|
||||||
/* Size for msg elem header depends on
|
/* Size for msg elem header depends on
|
||||||
vendor specific payload */
|
vendor specific payload */
|
||||||
d = handler->vendor ? dst+10 : dst+4;
|
// d = handler->vendor ? dst+10 : dst+4;
|
||||||
|
d = dst + params->msgset->header_len(handler);
|
||||||
|
|
||||||
/* put radio id */
|
/* put radio id */
|
||||||
|
|
||||||
|
len = cw_generic_write_l(params->cfg_list,((const cw_Type_t*)(handler->type)),
|
||||||
|
key, d, handler->param);
|
||||||
|
if (len==-1){
|
||||||
|
const char *vendor="";
|
||||||
|
if ( handler->vendor ) {
|
||||||
|
vendor=cw_strvendor(handler->vendor);
|
||||||
|
}
|
||||||
|
if ( params->elemdata->mand) {
|
||||||
|
cw_log(LOG_ERR,
|
||||||
|
"Can't put mandatory element %s %d-(%s) into %s. No value for '%s' found.",
|
||||||
|
vendor, handler->id, handler->name, params->msgdata->name
|
||||||
|
, handler->key
|
||||||
|
);
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
printf("Putting put byte index: %d\n",idx);
|
printf("Putting put byte index: %d\n",idx);
|
||||||
|
|
||||||
len += cw_put_byte(d+len,idx);
|
len += cw_put_byte(d+len,idx);
|
||||||
|
|
||||||
len += ((const cw_Type_t*)(handler->type))->put(elem,d+len);
|
// len += ((const cw_Type_t*)(handler->type))->put(elem,d+len);
|
||||||
/* l = len + cw_put_elem_hdr(dst, handler->id, len);*/
|
/* l = len + cw_put_elem_hdr(dst, handler->id, len);*/
|
||||||
|
|
||||||
|
return params->msgset->write_header(handler,dst,len);
|
||||||
|
|
||||||
|
/*
|
||||||
if (handler->vendor)
|
if (handler->vendor)
|
||||||
return len + cw_put_elem_vendor_hdr(dst, handler->vendor, handler->id, len);
|
return len + cw_put_elem_vendor_hdr(dst, handler->vendor, handler->id, len);
|
||||||
|
|
||||||
return len + cw_put_elem_hdr(dst, handler->id, len);
|
return len + cw_put_elem_hdr(dst, handler->id, len);*/
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -1,44 +0,0 @@
|
|||||||
#ifndef __CWMSG_H
|
|
||||||
#define __CWMSG_H
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
|
|
||||||
#include "radioinfo.h"
|
|
||||||
|
|
||||||
struct cwmsg{
|
|
||||||
uint8_t * buffer;
|
|
||||||
uint8_t * trnsprthdr;
|
|
||||||
uint8_t * ctrlhdr;
|
|
||||||
uint8_t * msgelems;
|
|
||||||
int pos;
|
|
||||||
int flags;
|
|
||||||
int hlen;
|
|
||||||
int rid;
|
|
||||||
int seqnum;
|
|
||||||
int type;
|
|
||||||
int capwap_mode;
|
|
||||||
};
|
|
||||||
|
|
||||||
struct conn;
|
|
||||||
|
|
||||||
/*
|
|
||||||
extern void cwmsg_init(struct cwmsg * cwmsg, uint8_t *buffer, int type, int seqnum, struct radioinfo * radioinfo);
|
|
||||||
//int cwmsg_send(struct cwmsg * cwmsg, int seqnum, int rid, struct conn * conn);
|
|
||||||
//
|
|
||||||
extern void cwmsg_addelem(struct cwmsg *msg,int type, const uint8_t *elem, int len);
|
|
||||||
extern void cwmsg_vaddelem(struct cwmsg *msg,int type, ...);
|
|
||||||
|
|
||||||
//extern void cwmsg_addelem_ac_descriptor(struct cwmsg *msg,struct ac_info * acinfo,struct wtpinfo * wtpinfo);
|
|
||||||
extern void cwmsg_addelem_ac_timestamp(struct cwmsg *msg);
|
|
||||||
|
|
||||||
|
|
||||||
extern void cwmsg_init_echo_request(struct cwmsg * cwmsg,uint8_t *buffer,struct conn * conn, struct radioinfo * radioinfo);
|
|
||||||
extern void cwmsg_addelem_mtu_discovery_padding(struct cwmsg * msg, struct conn* conn);
|
|
||||||
extern void cwmsg_addelem_image_identifier(struct cwmsg *msg,uint32_t vendor_id,uint8_t *img, int len);
|
|
||||||
|
|
||||||
//extern void cwmsg_addelem_radio_operational_state(struct cwmsg * cwmsg, struct radioinfo * ri);
|
|
||||||
|
|
||||||
extern void cwmsg_addelem_vendor_cisco_mwar_addr(struct cwmsg *msg, struct conn *conn);
|
|
||||||
*/
|
|
||||||
|
|
||||||
#endif
|
|
110
src/cw/dbg.c
110
src/cw/dbg.c
@ -55,7 +55,7 @@ uint32_t cw_dbg_opt_level = 0;
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
static struct cw_StrListElem color_on[] = {
|
static struct cw_StrListElem theme0[] = {
|
||||||
{DBG_PKT_IN, ANSI_YELLOW},
|
{DBG_PKT_IN, ANSI_YELLOW},
|
||||||
{DBG_PKT_OUT, ANSI_YELLOW ANSI_ITALIC},
|
{DBG_PKT_OUT, ANSI_YELLOW ANSI_ITALIC},
|
||||||
|
|
||||||
@ -86,7 +86,7 @@ static struct cw_StrListElem color_on[] = {
|
|||||||
|
|
||||||
{DBG_INFO, ANSI_DEFAULT},
|
{DBG_INFO, ANSI_DEFAULT},
|
||||||
|
|
||||||
{DBG_STATE, ANSI_BBLACK ANSI_BOLD },
|
{DBG_STATE, ANSI_GREEN ANSI_BOLD},
|
||||||
|
|
||||||
{DBG_RFC, ANSI_BRED},
|
{DBG_RFC, ANSI_BRED},
|
||||||
{DBG_X, "\x1b[31m"},
|
{DBG_X, "\x1b[31m"},
|
||||||
@ -98,6 +98,9 @@ static struct cw_StrListElem color_on[] = {
|
|||||||
{CW_STR_STOP, ""}
|
{CW_STR_STOP, ""}
|
||||||
};
|
};
|
||||||
|
|
||||||
|
static struct cw_StrListElem * color_on = theme0;
|
||||||
|
|
||||||
|
|
||||||
struct cw_StrListElem color_ontext[] = {
|
struct cw_StrListElem color_ontext[] = {
|
||||||
|
|
||||||
/* {DBG_ELEM_DMP, "\x1b[37m"},*/
|
/* {DBG_ELEM_DMP, "\x1b[37m"},*/
|
||||||
@ -132,7 +135,10 @@ static struct cw_StrListElem prefix[] = {
|
|||||||
{DBG_DTLS_DETAIL, " DTLS - "},
|
{DBG_DTLS_DETAIL, " DTLS - "},
|
||||||
{DBG_WARN, " Warning - "},
|
{DBG_WARN, " Warning - "},
|
||||||
{DBG_MOD, " Mod - "},
|
{DBG_MOD, " Mod - "},
|
||||||
{DBG_STATE, " State - "},
|
{DBG_STATE, " STATEMACHINE - "},
|
||||||
|
{DBG_CFG_SET, " Cfg Set - "},
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
{DBG_X, "XXXXX - "},
|
{DBG_X, "XXXXX - "},
|
||||||
|
|
||||||
@ -208,7 +214,7 @@ static void cw_dbg_vlog_line(struct cw_LogWriter * writer,
|
|||||||
/**
|
/**
|
||||||
* Put a list of missing mandatory message elements to debug output
|
* Put a list of missing mandatory message elements to debug output
|
||||||
*/
|
*/
|
||||||
void cw_dbg_missing_mand(int level, struct conn *conn, int ** ml, int n,
|
void cw_dbg_missing_mand(int level, struct cw_Conn *conn, int ** ml, int n,
|
||||||
int * a)
|
int * a)
|
||||||
{
|
{
|
||||||
/*
|
/*
|
||||||
@ -243,7 +249,7 @@ void cw_dbg_missing_mand(int level, struct conn *conn, int ** ml, int n,
|
|||||||
/**
|
/**
|
||||||
* Display a packet on for debugger
|
* Display a packet on for debugger
|
||||||
*/
|
*/
|
||||||
void cw_dbg_pkt(int level, struct conn *conn, uint8_t * packet, int len,
|
void cw_dbg_pkt(int level, struct cw_Conn *conn, uint8_t * packet, int len,
|
||||||
struct sockaddr *from)
|
struct sockaddr *from)
|
||||||
{
|
{
|
||||||
|
|
||||||
@ -305,7 +311,7 @@ void cw_dbg_dmp(int level, const uint8_t * data, int len, const char *format, ..
|
|||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
void cw_dbg_msg(int level, struct conn *conn, uint8_t * packet, int len,
|
void cw_dbg_msg(int level, struct cw_Conn *conn, uint8_t * packet, int len,
|
||||||
struct sockaddr *from)
|
struct sockaddr *from)
|
||||||
{
|
{
|
||||||
|
|
||||||
@ -360,96 +366,6 @@ void cw_dbg_msg(int level, struct conn *conn, uint8_t * packet, int len,
|
|||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
|
||||||
|
|
||||||
static int cw_format_vendor(char *dst, uint32_t vendor_id, int elem_id,
|
|
||||||
const uint8_t * elem_data)
|
|
||||||
{
|
|
||||||
uint32_t lw_elem_id;
|
|
||||||
switch (vendor_id) {
|
|
||||||
case CW_VENDOR_ID_CISCO:
|
|
||||||
{
|
|
||||||
if (elem_id != CW_CISCO_SPAM_VENDOR_SPECIFIC) {
|
|
||||||
return sprintf(dst, "%d - %s", elem_id,
|
|
||||||
cw_cisco_id_to_str(elem_id));
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
// dive into LWAPP vendor specific decoding
|
|
||||||
lw_elem_id = lw_get_word(elem_data + 4 + 6);
|
|
||||||
return sprintf(dst, "%d/LWAPP Vendor: %d - %s",
|
|
||||||
elem_id,
|
|
||||||
lw_elem_id, lw_cisco_id_to_str(lw_elem_id));
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
default:
|
|
||||||
{
|
|
||||||
return sprintf(dst, "%d", elem_id);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
void cw_dbg_version_subelem(int level, const char *context, int subtype,
|
|
||||||
uint32_t vendor_id, const uint8_t * vstr, int len)
|
|
||||||
{
|
|
||||||
char v[2048];
|
|
||||||
int n;
|
|
||||||
|
|
||||||
if (!cw_dbg_is_level(level))
|
|
||||||
return;
|
|
||||||
if (!vstr)
|
|
||||||
return;
|
|
||||||
n = cw_format_version(v, vstr, len);
|
|
||||||
|
|
||||||
sprintf(v + n, ", Vendor Id: %d, %s", vendor_id, cw_strvendor(vendor_id));
|
|
||||||
|
|
||||||
cw_dbg(level, "%s: SubType %d, %s", context, subtype, v);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
void cw_dbgv(struct cw_LogWriter *writer, int level, const char * format, va_list args)
|
|
||||||
{
|
|
||||||
char fbuf[1024];
|
|
||||||
|
|
||||||
if (writer->colored ){
|
|
||||||
sprintf(fbuf, "DBG:%s%s %s%s%s",
|
|
||||||
get_dbg_color_on(level),
|
|
||||||
get_dbg_prefix(level),
|
|
||||||
get_dbg_color_ontext(level), format, get_dbg_color_off(level)
|
|
||||||
);
|
|
||||||
}
|
|
||||||
else{
|
|
||||||
sprintf(fbuf, "DBG:%s %s",
|
|
||||||
get_dbg_prefix(level), format);
|
|
||||||
}
|
|
||||||
|
|
||||||
writer->write(LOG_DEBUG,fbuf,args,&cw_log_console_writer);
|
|
||||||
|
|
||||||
|
|
||||||
}
|
|
||||||
*/
|
|
||||||
|
|
||||||
/*
|
|
||||||
void cw_dbgv1(struct cw_LogWriter *writer, int level, const char * format, ...){
|
|
||||||
va_list args;
|
|
||||||
va_start(args, format);
|
|
||||||
cw_dbgv(writer,level,format,args);
|
|
||||||
va_end(args);
|
|
||||||
}
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
void cw_dbg(int level, const char *format, ...){
|
void cw_dbg(int level, const char *format, ...){
|
||||||
int i;
|
int i;
|
||||||
@ -470,7 +386,7 @@ void cw_dbg(int level, const char *format, ...){
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
void cw_dbg_elem(int level, struct conn *conn, int msg,
|
void cw_dbg_elem(int level, struct cw_Conn *conn, int msg,
|
||||||
struct cw_ElemHandler * handler, const uint8_t * msgbuf, int len)
|
struct cw_ElemHandler * handler, const uint8_t * msgbuf, int len)
|
||||||
{
|
{
|
||||||
char vendorname[256];
|
char vendorname[256];
|
||||||
|
Some files were not shown because too many files have changed in this diff Show More
Reference in New Issue
Block a user