diff --git a/src/capwap/cw_in_generic2.c b/src/capwap/cw_in_generic2.c new file mode 100644 index 00000000..eb1f3c5e --- /dev/null +++ b/src/capwap/cw_in_generic2.c @@ -0,0 +1,102 @@ + +#include "action.h" +#include "dbg.h" +#include "log.h" +#include "mbag.h" +#include "capwap.h" + + +int static check_len(struct conn *conn, struct cw_action_in *a, uint8_t * data, int len, + struct sockaddr *from) +{ + if (len < a->min_len) { + cw_dbg(DBG_ELEM_ERR, + "%d (%s) message element too short, len=%d, min len=%d", + a->elem_id, cw_strelemp(conn->actions, a->elem_id), len, + a->min_len); + return 0; + } + if (len > a->max_len) { + cw_dbg(DBG_ELEM_ERR, + "%d (%s) message element too big, len=%d, max len=%d", a->elem_id, + cw_strelemp(conn->actions, a->elem_id), len, a->max_len); + return 0; + } + + return 1; +} + + +int static do_save(mbag_t itemstore, struct conn *conn, struct cw_action_in *a, + uint8_t * data, int len, struct sockaddr *from) +{ + + if (a->itemtype == MBAG_BYTE) { + mbag_set_byte(itemstore, a->item_id, *data); + return 1; + } + if (a->itemtype == MBAG_WORD) { + mbag_set_word(itemstore, a->item_id, cw_get_word(data)); + return 1; + } + if (a->itemtype == MBAG_DWORD) { + mbag_set_dword(itemstore, a->item_id, cw_get_dword(data)); + return 1; + } + if (a->itemtype == MBAG_STR) { + mbag_set_strn(itemstore, a->item_id, (char *) data, len); + return 1; + } + if (a->itemtype == MBAG_BSTR) { + mbag_set_bstrn(itemstore, a->item_id, data, len); + return 1; + } + + if (a->itemtype == MBAG_BSTR16) { + mbag_set_bstr16n(itemstore, a->item_id, data, len); + return 1; + } + +/* if (a->itemtype == MBAG_DATA) { + mbag_set_data(itemstore, a->item_id, data, len); + return 1; + } +*/ + if (a->itemtype == MBAG_VENDORSTR) { + mbag_set_vendorstr(itemstore, a->item_id, + cw_get_dword(data), data + 4, len - 4); + return 1; + } + + cw_log(LOG_ERR, + "Can't handle item type %d in definition for incomming msg %d (%s) - %d, cw_in_generic.", + a->itemtype, a->msg_id, cw_strmsg(a->msg_id), a->elem_id); + return 0; + + +} + +int cw_in_generic2(struct conn *conn, struct cw_action_in *a, uint8_t * data, int len, + struct sockaddr *from) +{ + + printf("Here is cw in generic 2\n"); + exit(0); + + if (!check_len(conn, a, data, len, from)) + return 0; + + + mbag_t itemstore; +/// if (!a->target) + itemstore = conn->incomming; +// else +// itemstore = a->target(conn, a); + + + return do_save(itemstore, conn, a, data, len, from); + + + +} +