37 lines
795 B
C
37 lines
795 B
C
|
|
#include "cw.h"
|
|
|
|
/**
|
|
* Put an Operational State message element to a buffer.
|
|
* @param dst Destination buffer
|
|
* @param rid Radio ID
|
|
* @param os Operational State
|
|
* @param d7mode puts the Operational Stae element in CAPWAP draft 7 mode.
|
|
* @return Number of byes put
|
|
*/
|
|
int xcw_put_elem_radio_operational_state(uint8_t * dst, int rid, int os, int d7mode)
|
|
{
|
|
uint8_t *d=dst;
|
|
|
|
/* Put the radio ID */
|
|
cw_set_byte(d+4,rid);
|
|
|
|
if ( d7mode ){
|
|
/* Isolate Oper Sate from cause */
|
|
uint8_t o=os>>8;
|
|
|
|
/* Invert oper state for Cisco, if oper state is 2 or 1 */
|
|
if (o!=0 && o<=2) {
|
|
/* 2 becomes 1 and 1 becomes 2 */
|
|
os = (os & 0x00ff ) | ((3-o)<<8);
|
|
}
|
|
}
|
|
|
|
/* Put oper state */
|
|
cw_set_word(d+5,os);
|
|
d+=3+cw_put_elem_hdr(d,CAPWAP_ELEM_RADIO_OPERATIONAL_STATE,3);
|
|
|
|
return d-dst;
|
|
}
|
|
|