77 lines
1.4 KiB
C
77 lines
1.4 KiB
C
|
#include "dot11.h"
|
||
|
|
|
||
|
|
|
||
|
|
uint16_t dot11_get_word(uint8_t * ptr)
|
||
|
|
{
|
||
|
|
uint16_t w;
|
||
|
|
w = dot11_get_byte(ptr + 1);
|
||
|
|
w |= dot11_get_byte(ptr) << 8;
|
||
|
|
return w;
|
||
|
|
}
|
||
|
|
|
||
|
|
void dot11_get_address(uint8_t * dst, uint8_t * frame)
|
||
|
|
{
|
||
|
|
memcpy(dst, frame, 6);
|
||
|
|
}
|
||
|
|
|
||
|
|
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);
|
||
|
|
}
|
||
|
|
|
||
|
|
/**
|
||
|
|
* Get the current timestamp
|
||
|
|
* @return current timestamp in microseconds
|
||
|
|
*/
|
||
|
|
uint64_t dot11_timer_get()
|
||
|
|
{
|
||
|
|
struct timeval tv;
|
||
|
|
gettimeofday(&tv, NULL);
|
||
|
|
return 1000000 * tv.tv_sec + tv.tv_usec - dot11_timer_offset;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
|
||
|
|
void dot11_timer_set(uint64_t val)
|
||
|
|
{
|
||
|
|
struct timeval tv;
|
||
|
|
gettimeofday(&tv, NULL);
|
||
|
|
dot11_timer_offset = 1000000 * tv.tv_sec + tv.tv_usec - val;
|
||
|
|
}
|
||
|
|
|
||
|
|
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;
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
int dot11_put_supported_rates(uint8_t *dst, float *basic, float *rates){
|
||
|
|
uint8_t *d = dst+2;
|
||
|
|
while(*basic != 0.0){
|
||
|
|
*d++ = 0x80 | dot11_float2rate(*basic);
|
||
|
|
basic++;
|
||
|
|
}
|
||
|
|
while(*rates != 0.0){
|
||
|
|
*d++ = dot11_float2rate(*rates);
|
||
|
|
rates++;
|
||
|
|
}
|
||
|
|
*(dst)=DOT11_ELEM_SUPPORTED_RATES;
|
||
|
|
*(dst+1) = d-(dst+2);
|
||
|
|
|
||
|
|
return d-dst;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
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;
|
||
|
|
}
|
||
|
|
|
||
|
|
|