Inital commit LWAPP support.

FossilOrigin-Name: a529e32f33574b7c87b3707eaad936f292a28e595e93b71d3c6d5f1e2706d22c
This commit is contained in:
7u83@mail.ru 2015-03-15 19:45:52 +00:00
parent 575b442f78
commit e795fb71d0
1 changed files with 42 additions and 0 deletions

View File

@ -0,0 +1,42 @@
/**
* @file
* @brief Implementation of lw_readelem_wtp_board_data
*/
#include <arpa/inet.h>
#include "cw_log.h"
#include "wtpinfo.h"
#include "lwapp.h"
/**
* Read LWAPP board data element
* @param wtpinfo results are stored here
* @param type type of msg element (must be LWMSGELEM_WTP_BOARD_DATA)
* @param msgelem msg element data
* @param len length of msg element
* @return 0 if msg is not wtp board data\n
* 1 board data successful read
*/
int lw_readelem_wtp_board_data(struct wtpinfo *wtpinfo, int type, uint8_t *msgelem, int len)
{
if (type != LWMSGELEM_WTP_BOARD_DATA)
return 0;
if ( len != 46 ) {
cw_dbg(DBG_CW_MSG_ERR,"LWAPP msg size wrong. (WTP BOARD DATA) must be 46");
exit(0);
return -1;
}
uint16_t card_id = htonl( * ( (uint16_t*)(msgelem) ) );
uint16_t card_rev = htonl( * ( (uint16_t*)(msgelem +2 ) ) );
return 1;
}