planix.org
/
actube
2
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

More dot11 stuff added.

Browse Source 
FossilOrigin-Name: 4b8384a958e5d03f5ba00f874e528b541270cf022b1694862c9b84e6f3cbdfe3
bsdmakefiles
7u83@mail.ru 7 years ago
parent 8640c514cb
commit 93414da058
4 changed files with 223 additions and 31 deletions
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Show Stats Download Patch File Download Diff File
  1. 14
      src/cw/Makefile
  2. 1
      src/cw/dot11.c
  3. 205
      src/cw/dot11.h
  4. 34
      src/cw/dot11_beacon.c

14
src/cw/Makefile
Unescape View File

@ -171,8 +171,11 @@ CAPWAPOBJS= \
cw_check_missing_mand.o \
md5sum.o \
format.o \
cw_in_cisco_add_wlan.o \
dot11.o
cw_in_cisco_add_wlan.o
DOT11OBJS = \
dot11.o \
dot11_beacon.o
# cw_out_ac_descriptor.o \
@ -290,6 +293,7 @@ OBJS=$(CONNOBJS) $(FRAGOBJS) $(SOCKOBJS) $(CAPWAPOBJS) $(WTPINFOOBJS) \
$(LWAPPCISCOOBJS) \
$(CWACTION) \
$(MAVLOBJS) \
$(DOT11OBJS)
#include $(OBJS:.o=.d)
@ -356,7 +360,7 @@ clean:
clean_deps:
$(DEPS)
deps: $(SRCS)
$(CC) -MD -E $(SRCS) $(CFLAGS) >/dev/null
deps:
$(CC) -MM -E *.c $(CFLAGS) > .depend
-include $(DEPS)
include .depend

1
src/cw/dot11.c
Unescape View File

@ -6,6 +6,7 @@
uint64_t dot11_timer_offset=0;
uint8_t dot11_broadcast_address[6] = {0xff,0xff,0xff,0xff,0xff,0xff};
const unsigned char dot11_tab_br[] =

205
src/cw/dot11.h
Unescape View File

@ -9,19 +9,44 @@
* @{
*/
#include <stdint.h>
#include <string.h>
#include <sys/time.h>
#ifdef __FreeBSD__
#include <sys/ednian.h>
#else
#include <endian.h>
#endif
/**
* @defgroup DOT11_FRAME_TYPES Frame Types
* @brief Definition of frame types
*
* @{
*/
/** Management Frame */
#define DOT11_T_MGM 0b00
/** Control Frame */
#define DOT11_T_CTL 0b01
/** Data Frame **/
#define DOT11_T_DTA 0b10
/** Reserved Frame Type */
#define DOT11_T_RES 0b11
/**
* @}
*/
#define dot11_fc_mgm(subtype) (DOT11_T_MGM << 2 | subtype(<<4))
#define dot11_fc_mgm(subtype) ((DOT11_T_MGM << 2) |( subtype<<4))
#define dot11_fc_dta(subtype) ((DOT11_T_DTA << 2) |( subtype<<4))
/**
* @defgroup DOT11_FRAMES Frame Controls
*
* @{
*/
#define DOT11_FC_ASSOC_REQ dot11_fc_mgm(0b0000)
#define DOT11_FC_ASSOC_RESP dot11_fc_mgm(0b0001)
#define DOT11_FC_REASSOC_REQ dot11_fc_mgm(0b0010)
@ -32,9 +57,66 @@
#define DOT11_FC_MGM_RES111 dot11_fc_mgm(0b0111)
#define DOT11_FC_BEACON dot11_fc_mgm(0b1000)
#define DOT11_FC_DATA dot11_fc_dta(0b0000)
/**
* @}
*/
/**
* @defgroup DOT11_FC_FLAGS Frame Control Flags
* @{
*/
#define DOT11_FC_FLAG_TO_DS 0x100
#define DOT11_FC_FLAG_FROM_DS 0x200
#define DOT11_FC_FLAG_MOREFRAGS 0x400
#define DOT11_FC_FLAG_RETRY 0x800
#define DOT11_FC_FLAG_POWERMGMT 0x1000
#define DOT11_FC_FLAG_MOREDATA 0x2000
#define DOT11_FC_FLAG_PROTECTED 0x4000
#define DOT11_FC_FLAG_ORDER 0x8000
/**
* @}
*/
/**
* @defgroup DOT11_CAP_FLAGS Capability Flags
* @brief Flags used in the capability field.
* @{
*/
#define DOT11_CAP_ESS 0x0001
#define DOT11_CAP_IBSS 0x0002
#define DOT11_CAP_CF_POLLABLE 0x0004
#define DOT11_CAP_CF_POLL_REQ 0x0008
#define DOT11_CAP_PRIVACY 0x0010
#define DOT11_CAP_SHORT_PREAMBLE 0x0020
#define DOT11_CAP_PBCC 0x0040
#define DOT11_CAP_CHANNEL_AGILITY 0x0080
#define DOT11_CAP_SPEC_MGMT 0x0100
#define DOT11_CAP_QOS 0x0200
#define DOT11_CAP_SHORT_SLOT_TIME 0x0400
#define DOT11_CAP_APSD 0x0800
#define DOT11_CAP_RADIO_MEASURE 0x1000
#define DOT11_CAP_DSSS_ODFM 0x2000
#define DOT11_CAP_DELAYED_BLOCK_ACK 0x4000
#define DOT11_CAP_IMEDIATE_BLOCK_ACK 0x8000
/**
* @}
*/
/**
* @defgroup DOT11_ELEMS
* @{
*/
#define DOT11_ELEM_SSID 0
#define DOT11_ELEM_SUPPORTED_RATES 1
#define DOT11_ELEM_FH_PARAM_SET 2
#define DOT11_ELEM_DSSS_PARAM_SET 3
#define DOT11_ELEM_CF_PARAM_SET 4
/**
* @}
*/
extern const uint8_t dot11_tab_br[256];
@ -42,23 +124,24 @@ extern const uint8_t dot11_tab_br[256];
#define dot11_get_byte(ptr) (*(ptr))
#define dot11_put_byte(ptr,b) (*(ptr) = b)
#define dot11_put_word(dst,v) ((*((uint16_t*)(dst))=htobe16(v)),2)
#define dot11_put_dword(dst,v) ((*((uint16_t*)(dst))=htobe16(v)),4)
#define dot11_put_qword(dst,v) ((*((uint64_t*)(dst))=htobe64(v)),8)
static inline int dot11_put_word(uint8_t *ptr,uint16_t w)
{
dot11_put_byte(ptr+1,w&0xff);
dot11_put_byte(ptr,w>>8);
return 2;
}
static inline uint16_t dot11_get_word(uint8_t *ptr)
static inline uint16_t dot11_get_word(uint8_t * ptr)
{
uint16_t w;
w = dot11_get_byte(ptr+1);
w|= dot11_get_byte(ptr)<<8;
w = dot11_get_byte(ptr + 1);
w |= dot11_get_byte(ptr) << 8;
return w;
}
#define dot11_get_version(frame) ((frame[1])&0x03)
#define dot11_get_type(frame) (((frame[1])&0x0c) >> 2)
#define dot11_get_subtype(frame) (((frame[1])&0xf0) >> 4)
@ -71,26 +154,21 @@ static inline uint16_t dot11_get_word(uint8_t *ptr)
#define dot11_get_duration(frame) dot11_get_word(frame+2)
static inline void dot11_get_address(uint8_t * dst, uint8_t *frame)
static inline void dot11_get_address(uint8_t * dst, uint8_t * frame)
{
memcpy(dst,frame,6);
memcpy(dst, frame, 6);
}
#define dot11_get_address1(dst,frame) dot11_get_address(dst,frame+4)
#define dot11_get_address2(dst,frame) dot11_get_address(dst,frame+4*2*6)
#define dot11_get_address3(dst,frame) dot11_get_address(dst,frame+4*3*6)
#define dot11_get_address2(dst,frame) dot11_get_address(dst,frame+4+1*6)
#define dot11_get_address3(dst,frame) dot11_get_address(dst,frame+4+2*6)
#define dot11_get_sequence_control(frame) dot11_get_word(frame+22)
#define DOT11_FC_FLAG_FROM_DS 0x100
#define DOT11_FC_FLAG_TO_DS 0x200
#define DOT11_FC_FLAG_MOREFRAGS 0x400
#define DOT11_FC_FLAG_RETRY 0x800
#define DOT11_FC_FLAG_POWERMGMT 0x1000
#define DOT11_FC_FLAG_MOREDATA 0x2000
#define DOT11_FC_FLAG_PROTECTED 0x4000
#define DOT11_FC_FLAG_ORDER 0x8000
#define dot11_fc_get_version(fc) ((fc)&0x3)
#define dot11_fc_get_type(fc) (((fc)&0x0c)>>2)
@ -102,24 +180,99 @@ static inline void dot11_get_address(uint8_t * dst, uint8_t *frame)
#define dot11_fc_put_frame_control(dst,fc) dot11_put_word(dst,fc)
static inline int dot11_put_frame_control(uint8_t * dst, int fctype, int flags)
{
uint16_t fc = fctype | flags;
return dot11_fc_put_frame_control(dst, fc);
}
/**
* @defgroup DOT11_TIMER Timer
* @{
*/
extern uint64_t dot11_timer_offset;
static inline uint64_t dot11_timer_get(){
/**
* Get the current timestamp
* @return current timestamp in microseconds
*/
static inline uint64_t dot11_timer_get()
{
struct timeval tv;
gettimeofday(&tv, NULL);
return 1000000 * tv.tv_sec + tv.tv_usec - dot11_timer_offset;
}
static inline void dot11_timer_set(uint64_t val) {
static inline void dot11_timer_set(uint64_t val)
{
struct timeval tv;
gettimeofday(&tv, NULL);
dot11_timer_offset = 1000000 * tv.tv_sec + tv.tv_usec - val;
}
/**
* @}
*/
/**
* Put a timestamp field
* @param dst Destination
* @return number of bytes
*
* The timestamp value is taken from the value returned by #dot11_timer_get.
*/
#define dot11_put_timestamp(dst) (dot11_put_qword(dst,dot11_timer_get()))
#define dot11_put_beacon_interval(dst,v) (dot11_put_word(dst,v))
#define dot11_put_duration(dst,v) (dot11_put_word(dst,v))
#define dot11_put_address(dst,addr) (memcpy(dst,addr,6),6)
#define dot11_put_sequence_control(dst,v) (dot11_put_word(dst,v))
#define dot11_put_capability(dst,v) dot11_put_word(dst,v)
static inline int dot11_put_ssid(uint8_t *dst,uint8_t * ssid,int len){
dot11_put_byte(dst,DOT11_ELEM_SSID);
dot11_put_byte(dst+1,len);
memcpy(dst+2,ssid,len);
return len;
}
#define dot11_rate(rate) ((int)(rate*2+0.5));
static inline int dot11_put_supported_rates(uint8_t *dst, float *basic, float *rates){
uint8_t *d = dst+2;
while(*basic != 0.0){
*d++ = 0x80 | dot11_rate(*basic);
basic++;
}
while(*rates != 0.0){
*d++ = dot11_rate(*rates);
rates++;
}
*(dst)=DOT11_ELEM_SUPPORTED_RATES;
*(dst+1) = d-(dst+2);
return d-dst;
}
static inline int dot11_put_dsss_param_set(uint8_t *dst,int ch) {
dot11_put_byte(dst,DOT11_ELEM_DSSS_PARAM_SET);
dot11_put_byte(dst+1,1);
dot11_put_byte(dst+2,ch);
return 3;
}
extern int dot11_create_beacon(uint8_t *dst);
extern uint8_t dot11_broadcast_address[6];
#define DOT11_BROADCAST_ADDRESS (dot11_broadcast_address)
/**

34
src/cw/dot11_beacon.c
Unescape View File

@ -0,0 +1,34 @@
#include "dot11.h"
int dot11_create_beacon(uint8_t *dst)
{
uint8_t *d = dst;
d+=dot11_put_frame_control(d,DOT11_FC_BEACON,0);
d+=dot11_put_duration(d,0);
d+=dot11_put_address(d,DOT11_BROADCAST_ADDRESS);
uint8_t addr[6]={0x00,0x3a,0x99,0x02,0xfa,0xc0};
d+=dot11_put_address(d,addr);
d+=dot11_put_address(d,addr);
d+=dot11_put_sequence_control(d,17);
d+=dot11_put_timestamp(d);
d+=dot11_put_beacon_interval(d,100);
d+=dot11_put_capability(d,DOT11_CAP_ESS | DOT11_CAP_SHORT_PREAMBLE);
d+=dot11_put_ssid(d,(uint8_t*)"Hello Word",10);
float brates[] = {2,4,5.5,0.0};
float rates[] = {1,4,54,0.0};
d+=dot11_put_supported_rates(d,brates,rates);
d+=dot11_put_dsss_param_set(d,1);
return 0;
}
Write Preview
Loading…
Cancel
Save