freewtp/lib/element_wtpfallback.c

#include "capwap.h"
#include "element.h"

/********************************************************************

 0
 0 1 2 3 4 5 6 7
+-+-+-+-+-+-+-+-+
|     Mode      |
+-+-+-+-+-+-+-+-+

Type:   40 for WTP Fallback

Length:  1

********************************************************************/

/* */
static void capwap_wtpfallback_element_create(void* data, capwap_message_elements_handle handle, struct capwap_write_message_elements_ops* func) {
	struct capwap_wtpfallback_element* element = (struct capwap_wtpfallback_element*)data;

	ASSERT(data != NULL);
	ASSERT((element->mode == CAPWAP_WTP_FALLBACK_ENABLED) || (element->mode == CAPWAP_WTP_FALLBACK_DISABLED));

	/* */
	func->write_u8(handle, element->mode);
}

/* */
static void* capwap_wtpfallback_element_clone(void* data) {
	ASSERT(data != NULL);

	return capwap_clone(data, sizeof(struct capwap_wtpfallback_element));
}

/* */
static void capwap_wtpfallback_element_free(void* data) {
	ASSERT(data != NULL);
	
	capwap_free(data);
}

/* */
static void* capwap_wtpfallback_element_parsing(capwap_message_elements_handle handle, struct capwap_read_message_elements_ops* func) {
	struct capwap_wtpfallback_element* data;

	ASSERT(handle != NULL);
	ASSERT(func != NULL);

	if (func->read_ready(handle) != 1) {
		log_printf(LOG_DEBUG, "Invalid WTP Fallback element: underbuffer");
		return NULL;
	}

	/* Retrieve data */
	data = (struct capwap_wtpfallback_element*)capwap_alloc(sizeof(struct capwap_wtpfallback_element));
	func->read_u8(handle, &data->mode);
	if ((data->mode != CAPWAP_WTP_FALLBACK_ENABLED) && (data->mode != CAPWAP_WTP_FALLBACK_DISABLED)) {
		capwap_wtpfallback_element_free((void*)data);
		log_printf(LOG_DEBUG, "Invalid WTP Fallback element: invalid mode");
		return NULL;
	}

	return data;
}

/* */
const struct capwap_message_elements_ops capwap_element_wtpfallback_ops = {
	.category = CAPWAP_MESSAGE_ELEMENT_SINGLE,
	.create = capwap_wtpfallback_element_create,
	.parse = capwap_wtpfallback_element_parsing,
	.clone = capwap_wtpfallback_element_clone,
	.free = capwap_wtpfallback_element_free
};