mirror of https://github.com/hak5/openwrt.git
parent
cc823e6c53
commit
978958a888
|
@ -10,13 +10,13 @@ include $(TOPDIR)/rules.mk
|
|||
include $(INCLUDE_DIR)/kernel.mk
|
||||
|
||||
PKG_NAME:=broadcom-wl
|
||||
PKG_VERSION:=4.150.10.5.1
|
||||
PKG_VERSION:=4.150.10.5.2
|
||||
PKG_RELEASE:=1
|
||||
WLC_VERSION:=0.1
|
||||
|
||||
PKG_SOURCE:=$(PKG_NAME)-$(PKG_VERSION).tar.bz2
|
||||
PKG_SOURCE_URL:=http://downloads.openwrt.org/sources
|
||||
PKG_MD5SUM:=13cffebdcc08ef87673fbc02b2d56d52
|
||||
PKG_MD5SUM:=904a808dd98da076814fb7cb4b66a695
|
||||
|
||||
WL_WEXT=1
|
||||
|
||||
|
@ -101,6 +101,7 @@ endef
|
|||
|
||||
define Package/wl
|
||||
$(call Package/broadcom-wl/Default)
|
||||
DEPENDS+= +nvram
|
||||
TITLE:=Proprietary Broadcom wl driver config utility
|
||||
endef
|
||||
|
||||
|
@ -111,7 +112,7 @@ endef
|
|||
|
||||
define Package/nas
|
||||
$(call Package/broadcom-wl/Default)
|
||||
DEPENDS+= +nvram
|
||||
DEPENDS+= +nvram
|
||||
TITLE:=Proprietary Broadcom WPA/WPA2 authenticator
|
||||
endef
|
||||
|
||||
|
@ -155,7 +156,12 @@ define Build/Compile
|
|||
$(TARGET_CONFIGURE_OPTS) \
|
||||
CFLAGS="$(TARGET_CFLAGS)" \
|
||||
all
|
||||
$(TARGET_CC) -o $(PKG_BUILD_DIR)/nas $(PKG_BUILD_DIR)/nas_exe.o -L$(STAGING_DIR)/usr/lib -lnvram
|
||||
# Compile libshared
|
||||
$(MAKE) -C $(PKG_BUILD_DIR)/router/shared \
|
||||
$(TARGET_CONFIGURE_OPTS) \
|
||||
CFLAGS="$(TARGET_CFLAGS) -I. -I$(PKG_BUILD_DIR)/include -Dlinux=1" \
|
||||
all
|
||||
$(TARGET_CC) -o $(PKG_BUILD_DIR)/nas $(PKG_BUILD_DIR)/nas_exe.o -L$(STAGING_DIR)/usr/lib -lnvram $(PKG_BUILD_DIR)/router/shared/libshared.a
|
||||
$(TARGET_CC) -o $(PKG_BUILD_DIR)/wl $(PKG_BUILD_DIR)/wl_exe.o
|
||||
endef
|
||||
|
||||
|
|
|
@ -31,14 +31,14 @@ endef
|
|||
|
||||
define Build/InstallDev
|
||||
mkdir -p $(1)/usr/lib
|
||||
$(CP) $(PKG_BUILD_DIR)/lib{nvram,shared}*.so $(1)/usr/lib/
|
||||
$(CP) $(PKG_BUILD_DIR)/libnvram*.so $(1)/usr/lib/
|
||||
endef
|
||||
|
||||
define Package/nvram/install
|
||||
$(INSTALL_DIR) $(1)/etc/init.d
|
||||
$(INSTALL_BIN) ./files/nvram.init $(1)/etc/init.d/nvram
|
||||
$(INSTALL_DIR) $(1)/usr/lib
|
||||
$(CP) $(PKG_BUILD_DIR)/lib{nvram,shared}*.so $(1)/usr/lib/
|
||||
$(CP) $(PKG_BUILD_DIR)/libnvram*.so $(1)/usr/lib/
|
||||
$(INSTALL_DIR) $(1)/usr/sbin
|
||||
$(INSTALL_BIN) $(PKG_BUILD_DIR)/nvram $(1)/usr/sbin/
|
||||
endef
|
||||
|
|
|
@ -1,16 +1,12 @@
|
|||
# $Id$
|
||||
|
||||
LIBSHARED_OBJS := shutils.o wl.o linux_timer.o
|
||||
LIBNVRAM_OBJS := nvram.o
|
||||
|
||||
all: libshared.so libnvram.so nvram
|
||||
all: libnvram.so nvram
|
||||
|
||||
%.o: %.c
|
||||
$(CC) $(CFLAGS) $(EXTRA_CFLAGS) -c -I. -Iinclude -o $@ $^
|
||||
|
||||
libshared.so: $(LIBSHARED_OBJS)
|
||||
$(CC) -shared -o $@ $^
|
||||
|
||||
libnvram.so: $(LIBNVRAM_OBJS)
|
||||
$(CC) -shared -o $@ $^
|
||||
|
||||
|
|
|
@ -1,42 +0,0 @@
|
|||
/*
|
||||
* Copyright 2004, Broadcom Corporation
|
||||
* All Rights Reserved.
|
||||
*
|
||||
* THIS SOFTWARE IS OFFERED "AS IS", AND BROADCOM GRANTS NO WARRANTIES OF ANY
|
||||
* KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM
|
||||
* SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS
|
||||
* FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE.
|
||||
*
|
||||
* Low resolution timer interface. Timer handlers may be called
|
||||
* in a deferred manner in a different task context after the
|
||||
* timer expires or in the task context from which the timer
|
||||
* was created, depending on the implementation.
|
||||
*
|
||||
* $Id$
|
||||
*/
|
||||
#ifndef __bcmtimer_h__
|
||||
#define __bcmtimer_h__
|
||||
|
||||
/* ANSI headers */
|
||||
#include <time.h>
|
||||
|
||||
/* timer ID */
|
||||
typedef unsigned int bcm_timer_module_id;
|
||||
typedef unsigned int bcm_timer_id;
|
||||
|
||||
/* timer callback */
|
||||
typedef void (*bcm_timer_cb)(bcm_timer_id id, int data);
|
||||
|
||||
/* OS-independant interfaces, applications should call these functions only */
|
||||
int bcm_timer_module_init(int timer_entries, bcm_timer_module_id *module_id);
|
||||
int bcm_timer_module_cleanup(bcm_timer_module_id module_id);
|
||||
int bcm_timer_module_enable(bcm_timer_module_id module_id, int enable);
|
||||
int bcm_timer_create(bcm_timer_module_id module_id, bcm_timer_id *timer_id);
|
||||
int bcm_timer_delete(bcm_timer_id timer_id);
|
||||
int bcm_timer_gettime(bcm_timer_id timer_id, struct itimerspec *value);
|
||||
int bcm_timer_settime(bcm_timer_id timer_id, const struct itimerspec *value);
|
||||
int bcm_timer_connect(bcm_timer_id timer_id, bcm_timer_cb func, int data);
|
||||
int bcm_timer_cancel(bcm_timer_id timer_id);
|
||||
int bcm_timer_change_expirytime(bcm_timer_id timer_id, const struct itimerspec *timer_spec);
|
||||
|
||||
#endif /* #ifndef __bcmtimer_h__ */
|
|
@ -1,738 +0,0 @@
|
|||
/*
|
||||
* Copyright 2004, Broadcom Corporation
|
||||
* All Rights Reserved.
|
||||
*
|
||||
* THIS SOFTWARE IS OFFERED "AS IS", AND BROADCOM GRANTS NO WARRANTIES OF ANY
|
||||
* KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM
|
||||
* SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS
|
||||
* FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE.
|
||||
*
|
||||
* Low resolution timer interface linux specific implementation.
|
||||
*
|
||||
* $Id$
|
||||
*/
|
||||
|
||||
/*
|
||||
* debug facilities
|
||||
*/
|
||||
#define TIMER_DEBUG 0
|
||||
#if TIMER_DEBUG
|
||||
#define TIMERDBG(fmt, args...) printf("%s: " fmt "\n" , __FUNCTION__ , ## args)
|
||||
#else
|
||||
#define TIMERDBG(fmt, args...)
|
||||
#endif
|
||||
|
||||
|
||||
/*
|
||||
* POSIX timer support for Linux. Taken from linux_timer.c in upnp
|
||||
*/
|
||||
|
||||
#define __USE_GNU
|
||||
|
||||
|
||||
#include <stdlib.h> // for malloc, free, etc.
|
||||
#include <string.h> // for memset, strncasecmp, etc.
|
||||
#include <assert.h> // for assert, of course.
|
||||
#include <signal.h> // for sigemptyset, etc.
|
||||
#include <stdio.h> // for printf, etc.
|
||||
#include <sys/time.h>
|
||||
#include <time.h>
|
||||
|
||||
/* define TIMER_PROFILE to enable code which guages how accurate the timer functions are.
|
||||
For each expiring timer the code will print the expected time interval and the actual time interval.
|
||||
#define TIMER_PROFILE
|
||||
*/
|
||||
#undef TIMER_PROFILE
|
||||
|
||||
/*
|
||||
timer_cancel( ) - cancel a timer
|
||||
timer_connect( ) - connect a user routine to the timer signal
|
||||
timer_create( ) - allocate a timer using the specified clock for a timing base (POSIX)
|
||||
timer_delete( ) - remove a previously created timer (POSIX)
|
||||
timer_gettime( ) - get the remaining time before expiration and the reload value (POSIX)
|
||||
timer_getoverrun( ) - return the timer expiration overrun (POSIX)
|
||||
timer_settime( ) - set the time until the next expiration and arm timer (POSIX)
|
||||
nanosleep( ) - suspend the current task until the time interval elapses (POSIX)
|
||||
*/
|
||||
|
||||
#define MS_PER_SEC 1000
|
||||
#define US_PER_SEC 1000000
|
||||
#define US_PER_MS 1000
|
||||
#define UCLOCKS_PER_SEC 1000000
|
||||
|
||||
typedef void (*event_callback_t)(timer_t, int);
|
||||
|
||||
#ifndef TIMESPEC_TO_TIMEVAL
|
||||
# define TIMESPEC_TO_TIMEVAL(tv, ts) { \
|
||||
(tv)->tv_sec = (ts)->tv_sec; \
|
||||
(tv)->tv_usec = (ts)->tv_nsec / 1000; \
|
||||
}
|
||||
#endif
|
||||
|
||||
#ifndef TIMEVAL_TO_TIMESPEC
|
||||
# define TIMEVAL_TO_TIMESPEC(tv, ts) { \
|
||||
(ts)->tv_sec = (tv)->tv_sec; \
|
||||
(ts)->tv_nsec = (tv)->tv_usec * 1000; \
|
||||
}
|
||||
#endif
|
||||
|
||||
#define ROUNDUP(x,y) ((((x)+(y)-1)/(y))*(y))
|
||||
|
||||
#define timerroundup(t,g) \
|
||||
do { \
|
||||
if (!timerisset(t)) (t)->tv_usec=1; \
|
||||
if ((t)->tv_sec == 0) (t)->tv_usec=ROUNDUP((t)->tv_usec, g); \
|
||||
} while (0)
|
||||
|
||||
typedef long uclock_t;
|
||||
|
||||
#define TFLAG_NONE 0
|
||||
#define TFLAG_CANCELLED (1<<0)
|
||||
#define TFLAG_DELETED (1<<1)
|
||||
|
||||
struct event {
|
||||
struct timeval it_interval;
|
||||
struct timeval it_value;
|
||||
event_callback_t func;
|
||||
int arg;
|
||||
unsigned short flags;
|
||||
struct event *next;
|
||||
#ifdef TIMER_PROFILE
|
||||
uint expected_ms;
|
||||
uclock_t start;
|
||||
#endif
|
||||
};
|
||||
|
||||
void timer_cancel(timer_t timerid);
|
||||
|
||||
static void alarm_handler(int i);
|
||||
static void check_event_queue();
|
||||
static void print_event_queue();
|
||||
static void check_timer();
|
||||
#if THIS_FINDS_USE
|
||||
static int count_queue(struct event *);
|
||||
#endif
|
||||
static int timer_change_settime(timer_t timer_id, const struct itimerspec *timer_spec);
|
||||
void block_timer();
|
||||
void unblock_timer();
|
||||
|
||||
static struct event *event_queue = NULL;
|
||||
static struct event *event_freelist;
|
||||
static uint g_granularity;
|
||||
static int g_maxevents = 0;
|
||||
|
||||
uclock_t uclock()
|
||||
{
|
||||
struct timeval tv;
|
||||
|
||||
gettimeofday(&tv, NULL);
|
||||
return ((tv.tv_sec * US_PER_SEC) + tv.tv_usec);
|
||||
}
|
||||
|
||||
|
||||
void init_event_queue(int n)
|
||||
{
|
||||
int i;
|
||||
struct itimerval tv;
|
||||
|
||||
g_maxevents = n;
|
||||
event_freelist = (struct event *) malloc(n * sizeof(struct event));
|
||||
memset(event_freelist, 0, n * sizeof(struct event));
|
||||
|
||||
for (i = 0; i < (n-1); i++)
|
||||
event_freelist[i].next = &event_freelist[i+1];
|
||||
|
||||
event_freelist[i].next = NULL;
|
||||
|
||||
tv.it_interval.tv_sec = 0;
|
||||
tv.it_interval.tv_usec = 1;
|
||||
tv.it_value.tv_sec = 0;
|
||||
tv.it_value.tv_usec = 0;
|
||||
setitimer (ITIMER_REAL, &tv, 0);
|
||||
setitimer (ITIMER_REAL, 0, &tv);
|
||||
g_granularity = tv.it_interval.tv_usec;
|
||||
|
||||
signal(SIGALRM, alarm_handler);
|
||||
}
|
||||
|
||||
|
||||
int clock_gettime(
|
||||
clockid_t clock_id, /* clock ID (always CLOCK_REALTIME) */
|
||||
struct timespec * tp /* where to store current time */
|
||||
)
|
||||
{
|
||||
struct timeval tv;
|
||||
int n;
|
||||
|
||||
|
||||
n = gettimeofday(&tv, NULL);
|
||||
TIMEVAL_TO_TIMESPEC(&tv, tp);
|
||||
|
||||
return n;
|
||||
}
|
||||
|
||||
|
||||
int timer_create(
|
||||
clockid_t clock_id, /* clock ID (always CLOCK_REALTIME) */
|
||||
struct sigevent * evp, /* user event handler */
|
||||
timer_t * pTimer /* ptr to return value */
|
||||
)
|
||||
{
|
||||
struct event *event;
|
||||
|
||||
if (clock_id != CLOCK_REALTIME) {
|
||||
TIMERDBG("timer_create can only support clock id CLOCK_REALTIME");
|
||||
exit(1);
|
||||
}
|
||||
|
||||
if (evp != NULL) {
|
||||
if (evp->sigev_notify != SIGEV_SIGNAL || evp->sigev_signo != SIGALRM) {
|
||||
TIMERDBG("timer_create can only support signalled alarms using SIGALRM");
|
||||
exit(1);
|
||||
}
|
||||
}
|
||||
|
||||
event = event_freelist;
|
||||
if (event == NULL) {
|
||||
print_event_queue();
|
||||
}
|
||||
assert(event != NULL);
|
||||
|
||||
event->flags = TFLAG_NONE;
|
||||
|
||||
event_freelist = event->next;
|
||||
event->next = NULL;
|
||||
|
||||
check_event_queue();
|
||||
|
||||
*pTimer = (timer_t) event;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int timer_delete(
|
||||
timer_t timerid /* timer ID */
|
||||
)
|
||||
{
|
||||
struct event *event = (struct event *) timerid;
|
||||
|
||||
if (event->flags & TFLAG_DELETED) {
|
||||
TIMERDBG("Cannot delete a deleted event");
|
||||
return 1;
|
||||
}
|
||||
|
||||
timer_cancel(timerid);
|
||||
|
||||
event->flags |= TFLAG_DELETED;
|
||||
|
||||
event->next = event_freelist;
|
||||
event_freelist = event;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int timer_connect
|
||||
(
|
||||
timer_t timerid, /* timer ID */
|
||||
void (*routine)(timer_t, int), /* user routine */
|
||||
int arg /* user argument */
|
||||
)
|
||||
{
|
||||
struct event *event = (struct event *) timerid;
|
||||
|
||||
assert(routine != NULL);
|
||||
event->func = routine;
|
||||
event->arg = arg;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Please Call this function only from the call back functions of the alarm_handler.
|
||||
* This is just a hack
|
||||
*/
|
||||
int timer_change_settime
|
||||
(
|
||||
timer_t timerid, /* timer ID */
|
||||
const struct itimerspec * value /* time to be set */
|
||||
)
|
||||
{
|
||||
struct event *event = (struct event *) timerid;
|
||||
|
||||
TIMESPEC_TO_TIMEVAL(&event->it_interval, &value->it_interval);
|
||||
TIMESPEC_TO_TIMEVAL(&event->it_value, &value->it_value);
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
int timer_settime
|
||||
(
|
||||
timer_t timerid, /* timer ID */
|
||||
int flags, /* absolute or relative */
|
||||
const struct itimerspec * value, /* time to be set */
|
||||
struct itimerspec * ovalue /* previous time set (NULL=no result) */
|
||||
)
|
||||
{
|
||||
struct itimerval itimer;
|
||||
struct event *event = (struct event *) timerid;
|
||||
struct event **ppevent;
|
||||
|
||||
TIMESPEC_TO_TIMEVAL(&event->it_interval, &value->it_interval);
|
||||
TIMESPEC_TO_TIMEVAL(&event->it_value, &value->it_value);
|
||||
|
||||
/* if .it_value is zero, the timer is disarmed */
|
||||
if (!timerisset(&event->it_value)) {
|
||||
timer_cancel(timerid);
|
||||
return 0;
|
||||
}
|
||||
|
||||
block_timer();
|
||||
|
||||
#ifdef TIMER_PROFILE
|
||||
event->expected_ms = (event->it_value.tv_sec * MS_PER_SEC) + (event->it_value.tv_usec / US_PER_MS);
|
||||
event->start = uclock();
|
||||
#endif
|
||||
if (event->next) {
|
||||
TIMERDBG("calling timer_settime with a timer that is already on the queue.");
|
||||
}
|
||||
|
||||
|
||||
/* We always want to make sure that the event at the head of the
|
||||
queue has a timeout greater than the itimer granularity.
|
||||
Otherwise we end up with the situation that the time remaining
|
||||
on an itimer is greater than the time at the head of the queue
|
||||
in the first place. */
|
||||
timerroundup(&event->it_value, g_granularity);
|
||||
|
||||
timerclear(&itimer.it_value);
|
||||
getitimer(ITIMER_REAL, &itimer);
|
||||
if (timerisset(&itimer.it_value)) {
|
||||
// reset the top timer to have an interval equal to the remaining interval
|
||||
// when the timer was cancelled.
|
||||
if (event_queue) {
|
||||
if (timercmp(&(itimer.it_value), &(event_queue->it_value), >)) {
|
||||
// it is an error if the amount of time remaining is more than the amount of time
|
||||
// requested by the top event.
|
||||
//
|
||||
TIMERDBG("timer_settime: TIMER ERROR!");
|
||||
|
||||
} else {
|
||||
// some portion of the top event has already expired.
|
||||
// Reset the interval of the top event to remaining
|
||||
// time left in that interval.
|
||||
//
|
||||
event_queue->it_value = itimer.it_value;
|
||||
|
||||
// if we were the earliest timer before now, we are still the earliest timer now.
|
||||
// we do not need to reorder the list.
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
// Now, march down the list, decrementing the new timer by the
|
||||
// current it_value of each event on the queue.
|
||||
ppevent = &event_queue;
|
||||
while (*ppevent) {
|
||||
if ( timercmp(&(event->it_value), &((*ppevent)->it_value), <) ) {
|
||||
// if the proposed event will trigger sooner than the next event
|
||||
// in the queue, we will insert the new event just before the next one.
|
||||
//
|
||||
// we also need to adjust the delta value to the next event.
|
||||
timersub(&((*ppevent)->it_value), &(event->it_value), &((*ppevent)->it_value));
|
||||
break;
|
||||
}
|
||||
// subtract the interval of the next event from the proposed interval.
|
||||
timersub(&(event->it_value), &((*ppevent)->it_value), &(event->it_value));
|
||||
|
||||
ppevent = &((*ppevent)->next);
|
||||
}
|
||||
|
||||
// we have found our proper place in the queue,
|
||||
// link our new event into the pending event queue.
|
||||
event->next = *ppevent;
|
||||
*ppevent = event;
|
||||
|
||||
check_event_queue();
|
||||
|
||||
// if our new event ended up at the front of the queue, reissue the timer.
|
||||
if (event == event_queue) {
|
||||
timerroundup(&event_queue->it_value, g_granularity);
|
||||
timerclear(&itimer.it_interval);
|
||||
itimer.it_value = event_queue->it_value;
|
||||
|
||||
// we want to be sure to never turn off the timer completely,
|
||||
// so if the next interval is zero, set it to some small value.
|
||||
if (!timerisset(&(itimer.it_value)))
|
||||
itimer.it_value = (struct timeval) { 0, 1 };
|
||||
|
||||
assert(!timerisset(&itimer.it_interval));
|
||||
assert(itimer.it_value.tv_sec > 0 || itimer.it_value.tv_usec >= g_granularity);
|
||||
assert(event_queue->it_value.tv_sec > 0 || event_queue->it_value.tv_usec >= g_granularity);
|
||||
setitimer(ITIMER_REAL, &itimer, NULL);
|
||||
check_timer();
|
||||
}
|
||||
|
||||
event->flags &= ~TFLAG_CANCELLED;
|
||||
|
||||
unblock_timer();
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void check_timer()
|
||||
{
|
||||
struct itimerval itimer;
|
||||
|
||||
getitimer(ITIMER_REAL, &itimer);
|
||||
if (timerisset(&itimer.it_interval)) {
|
||||
TIMERDBG("ERROR timer interval is set.");
|
||||
}
|
||||
if (timercmp(&(itimer.it_value), &(event_queue->it_value), >)) {
|
||||
TIMERDBG("ERROR timer expires later than top event.");
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static void check_event_queue()
|
||||
{
|
||||
struct timeval sum;
|
||||
struct event *event;
|
||||
int i = 0;
|
||||
|
||||
#ifdef notdef
|
||||
int nfree = 0;
|
||||
struct event *p;
|
||||
for (p = event_freelist; p; p = p->next)
|
||||
nfree++;
|
||||
printf("%d free events\n", nfree);
|
||||
#endif
|
||||
|
||||
timerclear(&sum);
|
||||
for (event = event_queue; event; event = event->next) {
|
||||
if (i > g_maxevents) {
|
||||
TIMERDBG("timer queue looks like it loops back on itself!");
|
||||
print_event_queue();
|
||||
exit(1);
|
||||
}
|
||||
i++;
|
||||
}
|
||||
}
|
||||
|
||||
#if THIS_FINDS_USE
|
||||
/* The original upnp version has this unused function, so I left it in
|
||||
to maintain the resemblance. */
|
||||
static int count_queue(struct event *event_queue)
|
||||
{
|
||||
struct event *event;
|
||||
int i = 0;
|
||||
for (event = event_queue; event; event = event->next)
|
||||
i++;
|
||||
return i;
|
||||
}
|
||||
#endif
|
||||
|
||||
static void print_event_queue()
|
||||
{
|
||||
struct event *event;
|
||||
int i = 0;
|
||||
|
||||
for (event = event_queue; event; event = event->next) {
|
||||
printf("#%d (0x%x)->0x%x: \t%d sec %d usec\t%p\n",
|
||||
i++, (unsigned int) event, (unsigned int) event->next, (int) event->it_value.tv_sec, (int) event->it_value.tv_usec, event->func);
|
||||
if (i > g_maxevents) {
|
||||
printf("...(giving up)\n");
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
// The top element of the event queue must have expired.
|
||||
// Remove that element, run its function, and reset the timer.
|
||||
// if there is no interval, recycle the event structure.
|
||||
static void alarm_handler(int i)
|
||||
{
|
||||
struct event *event, **ppevent;
|
||||
struct itimerval itimer;
|
||||
struct timeval small_interval = { 0, g_granularity/2 };
|
||||
#ifdef TIMER_PROFILE
|
||||
uint junk;
|
||||
uclock_t end;
|
||||
uint actual;
|
||||
#endif
|
||||
|
||||
block_timer();
|
||||
|
||||
// Loop through the event queue and remove the first event plus any
|
||||
// subsequent events that will expire very soon thereafter (within 'small_interval'}.
|
||||
//
|
||||
do {
|
||||
// remove the top event.
|
||||
event = event_queue;
|
||||
event_queue = event_queue->next;
|
||||
event->next = NULL;
|
||||
|
||||
#ifdef TIMER_PROFILE
|
||||
end = uclock();
|
||||
actual = ((end-event->start)/((uclock_t)UCLOCKS_PER_SEC/1000));
|
||||
if (actual < 0)
|
||||
junk = end;
|
||||
TIMERDBG("expected %d ms actual %d ms", event->expected_ms, ((end-event->start)/((uclock_t)UCLOCKS_PER_SEC/1000)));
|
||||
#endif
|
||||
|
||||
// call the event callback function
|
||||
(*(event->func))((timer_t) event, (int)event->arg);
|
||||
|
||||
/* If the event has been cancelled, do NOT put it back on the queue. */
|
||||
if ( !(event->flags & TFLAG_CANCELLED) ) {
|
||||
|
||||
// if the event is a recurring event, reset the timer and
|
||||
// find its correct place in the sorted list of events.
|
||||
//
|
||||
if (timerisset(&event->it_interval)) {
|
||||
// event is recurring...
|
||||
//
|
||||
event->it_value = event->it_interval;
|
||||
#ifdef TIMER_PROFILE
|
||||
event->expected_ms = (event->it_value.tv_sec * MS_PER_SEC) + (event->it_value.tv_usec / US_PER_MS);
|
||||
event->start = uclock();
|
||||
#endif
|
||||
timerroundup(&event->it_value, g_granularity);
|
||||
|
||||
// Now, march down the list, decrementing the new timer by the
|
||||
// current delta of each event on the queue.
|
||||
ppevent = &event_queue;
|
||||
while (*ppevent) {
|
||||
if ( timercmp(&(event->it_value), &((*ppevent)->it_value), <) ) {
|
||||
// if the proposed event will trigger sooner than the next event
|
||||
// in the queue, we will insert the new event just before the next one.
|
||||
//
|
||||
// we also need to adjust the delta value to the next event.
|
||||
timersub(&((*ppevent)->it_value), &(event->it_value), &((*ppevent)->it_value));
|
||||
break;
|
||||
}
|
||||
timersub(&(event->it_value), &((*ppevent)->it_value), &(event->it_value));
|
||||
ppevent = &((*ppevent)->next);
|
||||
}
|
||||
|
||||
// we have found our proper place in the queue,
|
||||
// link our new event into the pending event queue.
|
||||
event->next = *ppevent;
|
||||
*ppevent = event;
|
||||
} else {
|
||||
// there is no interval, so recycle the event structure.
|
||||
//timer_delete((timer_t) event);
|
||||
}
|
||||
}
|
||||
|
||||
check_event_queue();
|
||||
|
||||
} while (event_queue && timercmp(&event_queue->it_value, &small_interval, <));
|
||||
|
||||
// re-issue the timer...
|
||||
if (event_queue) {
|
||||
timerroundup(&event_queue->it_value, g_granularity);
|
||||
|
||||
timerclear(&itimer.it_interval);
|
||||
itimer.it_value = event_queue->it_value;
|
||||
// we want to be sure to never turn off the timer completely,
|
||||
// so if the next interval is zero, set it to some small value.
|
||||
if (!timerisset(&(itimer.it_value)))
|
||||
itimer.it_value = (struct timeval) { 0, 1 };
|
||||
|
||||
setitimer(ITIMER_REAL, &itimer, NULL);
|
||||
check_timer();
|
||||
} else {
|
||||
TIMERDBG("There are no events in the queue - timer not reset.");
|
||||
}
|
||||
|
||||
unblock_timer();
|
||||
}
|
||||
|
||||
static int block_count = 0;
|
||||
|
||||
void block_timer()
|
||||
{
|
||||
sigset_t set;
|
||||
|
||||
if (block_count++ == 0) {
|
||||
sigemptyset(&set);
|
||||
sigaddset(&set, SIGALRM);
|
||||
sigprocmask(SIG_BLOCK, &set, NULL);
|
||||
}
|
||||
}
|
||||
|
||||
void unblock_timer()
|
||||
{
|
||||
sigset_t set;
|
||||
|
||||
if (--block_count == 0) {
|
||||
sigemptyset(&set);
|
||||
sigaddset(&set, SIGALRM);
|
||||
sigprocmask(SIG_UNBLOCK, &set, NULL);
|
||||
}
|
||||
}
|
||||
|
||||
void timer_cancel_all()
|
||||
{
|
||||
struct itimerval timeroff = { { 0, 0 }, { 0, 0} };
|
||||
struct event *event;
|
||||
struct event **ppevent;
|
||||
|
||||
setitimer(ITIMER_REAL, &timeroff, NULL);
|
||||
|
||||
ppevent = &event_queue;
|
||||
while (*ppevent) {
|
||||
event = *ppevent;
|
||||
*ppevent = event->next;
|
||||
event->next = NULL;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
void timer_cancel(timer_t timerid)
|
||||
{
|
||||
struct itimerval itimer;
|
||||
struct itimerval timeroff = { { 0, 0 }, { 0, 0} };
|
||||
struct event *event = (struct event *) timerid;
|
||||
struct event **ppevent;
|
||||
|
||||
if (event->flags & TFLAG_CANCELLED) {
|
||||
TIMERDBG("Cannot cancel a cancelled event");
|
||||
return;
|
||||
}
|
||||
|
||||
block_timer();
|
||||
|
||||
ppevent = &event_queue;
|
||||
while (*ppevent) {
|
||||
if ( *ppevent == event ) {
|
||||
|
||||
/* RACE CONDITION - if the alarm goes off while we are in
|
||||
this loop, and if the timer we want to cancel is the
|
||||
next to expire, the alarm will end up firing
|
||||
after this routine is complete, causing it to go off early. */
|
||||
|
||||
/* If the cancelled timer is the next to expire,
|
||||
we need to do something special to clean up correctly. */
|
||||
if (event == event_queue && event->next != NULL) {
|
||||
timerclear(&itimer.it_value);
|
||||
getitimer(ITIMER_REAL, &itimer);
|
||||
|
||||
/* subtract the time that has already passed while waiting for this timer... */
|
||||
timersub(&(event->it_value), &(itimer.it_value), &(event->it_value));
|
||||
|
||||
/* and add any remainder to the next timer in the list */
|
||||
timeradd(&(event->next->it_value), &(event->it_value), &(event->next->it_value));
|
||||
}
|
||||
|
||||
*ppevent = event->next;
|
||||
event->next = NULL;
|
||||
|
||||
if (event_queue) {
|
||||
timerroundup(&event_queue->it_value, g_granularity);
|
||||
timerclear(&itimer.it_interval);
|
||||
itimer.it_value = event_queue->it_value;
|
||||
|
||||
/* We want to be sure to never turn off the timer
|
||||
completely if there are more events on the queue,
|
||||
so if the next interval is zero, set it to some
|
||||
small value. */
|
||||
|
||||
if (!timerisset(&(itimer.it_value)))
|
||||
itimer.it_value = (struct timeval) { 0, 1 };
|
||||
|
||||
assert(itimer.it_value.tv_sec > 0 || itimer.it_value.tv_usec >= g_granularity);
|
||||
assert(event_queue->it_value.tv_sec > 0 || event_queue->it_value.tv_usec >= g_granularity);
|
||||
setitimer(ITIMER_REAL, &itimer, NULL);
|
||||
check_timer();
|
||||
} else {
|
||||
setitimer(ITIMER_REAL, &timeroff, NULL);
|
||||
}
|
||||
break;
|
||||
}
|
||||
ppevent = &((*ppevent)->next);
|
||||
}
|
||||
|
||||
event->flags |= TFLAG_CANCELLED;
|
||||
|
||||
unblock_timer();
|
||||
}
|
||||
|
||||
/*
|
||||
* timer related headers
|
||||
*/
|
||||
#include "bcmtimer.h"
|
||||
|
||||
/*
|
||||
* locally used global variables and constants
|
||||
*/
|
||||
|
||||
/*
|
||||
* Initialize internal resources used in the timer module. It must be called
|
||||
* before any other timer function calls. The param 'timer_entries' is used
|
||||
* to pre-allocate fixed number of timer entries.
|
||||
*/
|
||||
int bcm_timer_module_init(int timer_entries, bcm_timer_module_id *module_id)
|
||||
{
|
||||
init_event_queue(timer_entries);
|
||||
*module_id = (bcm_timer_module_id)event_freelist;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Cleanup internal resources used by this timer module. It deletes all
|
||||
* pending timer entries from the backend timer system as well.
|
||||
*/
|
||||
int bcm_timer_module_cleanup(bcm_timer_module_id module_id)
|
||||
{
|
||||
module_id = 0;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Enable/Disable timer module */
|
||||
int bcm_timer_module_enable(bcm_timer_module_id module_id, int enable)
|
||||
{
|
||||
if (enable)
|
||||
unblock_timer();
|
||||
else
|
||||
block_timer();
|
||||
return 0;
|
||||
}
|
||||
|
||||
int bcm_timer_create(bcm_timer_module_id module_id, bcm_timer_id *timer_id)
|
||||
{
|
||||
module_id = 0;
|
||||
return timer_create(CLOCK_REALTIME, NULL, (timer_t *)timer_id);
|
||||
}
|
||||
|
||||
int bcm_timer_delete(bcm_timer_id timer_id)
|
||||
{
|
||||
return timer_delete((timer_t)timer_id);
|
||||
}
|
||||
|
||||
int bcm_timer_gettime(bcm_timer_id timer_id, struct itimerspec *timer_spec)
|
||||
{
|
||||
return -1;
|
||||
}
|
||||
|
||||
int bcm_timer_settime(bcm_timer_id timer_id, const struct itimerspec *timer_spec)
|
||||
{
|
||||
return timer_settime((timer_t)timer_id, 0, timer_spec, NULL);
|
||||
}
|
||||
|
||||
int bcm_timer_connect(bcm_timer_id timer_id, bcm_timer_cb func, int data)
|
||||
{
|
||||
return timer_connect((timer_t)timer_id, (void *)func, data);
|
||||
}
|
||||
|
||||
int bcm_timer_cancel(bcm_timer_id timer_id)
|
||||
{
|
||||
timer_cancel((timer_t)timer_id);
|
||||
return 0;
|
||||
}
|
||||
int bcm_timer_change_expirytime(bcm_timer_id timer_id, const struct itimerspec *timer_spec)
|
||||
{
|
||||
timer_change_settime((timer_t)timer_id, timer_spec);
|
||||
return 1;
|
||||
}
|
|
@ -1,329 +0,0 @@
|
|||
/*
|
||||
* Shell-like utility functions
|
||||
*
|
||||
* Copyright 2004, Broadcom Corporation
|
||||
* All Rights Reserved.
|
||||
*
|
||||
* THIS SOFTWARE IS OFFERED "AS IS", AND BROADCOM GRANTS NO WARRANTIES OF ANY
|
||||
* KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM
|
||||
* SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS
|
||||
* FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE.
|
||||
*
|
||||
* $Id$
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <stdarg.h>
|
||||
#include <errno.h>
|
||||
#include <error.h>
|
||||
#include <fcntl.h>
|
||||
#include <limits.h>
|
||||
#include <unistd.h>
|
||||
#include <signal.h>
|
||||
#include <string.h>
|
||||
#include <sys/types.h>
|
||||
#include <sys/stat.h>
|
||||
#include <sys/wait.h>
|
||||
#include <termios.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include <sys/time.h>
|
||||
#include <net/ethernet.h>
|
||||
|
||||
#include <shutils.h>
|
||||
|
||||
/*
|
||||
* Reads file and returns contents
|
||||
* @param fd file descriptor
|
||||
* @return contents of file or NULL if an error occurred
|
||||
*/
|
||||
char *
|
||||
fd2str(int fd)
|
||||
{
|
||||
char *buf = NULL;
|
||||
size_t count = 0, n;
|
||||
|
||||
do {
|
||||
buf = realloc(buf, count + 512);
|
||||
n = read(fd, buf + count, 512);
|
||||
if (n < 0) {
|
||||
free(buf);
|
||||
buf = NULL;
|
||||
}
|
||||
count += n;
|
||||
} while (n == 512);
|
||||
|
||||
close(fd);
|
||||
if (buf)
|
||||
buf[count] = '\0';
|
||||
return buf;
|
||||
}
|
||||
|
||||
/*
|
||||
* Reads file and returns contents
|
||||
* @param path path to file
|
||||
* @return contents of file or NULL if an error occurred
|
||||
*/
|
||||
char *
|
||||
file2str(const char *path)
|
||||
{
|
||||
int fd;
|
||||
|
||||
if ((fd = open(path, O_RDONLY)) == -1) {
|
||||
perror(path);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
return fd2str(fd);
|
||||
}
|
||||
|
||||
/*
|
||||
* Waits for a file descriptor to change status or unblocked signal
|
||||
* @param fd file descriptor
|
||||
* @param timeout seconds to wait before timing out or 0 for no timeout
|
||||
* @return 1 if descriptor changed status or 0 if timed out or -1 on error
|
||||
*/
|
||||
int
|
||||
waitfor(int fd, int timeout)
|
||||
{
|
||||
fd_set rfds;
|
||||
struct timeval tv = { timeout, 0 };
|
||||
|
||||
FD_ZERO(&rfds);
|
||||
FD_SET(fd, &rfds);
|
||||
return select(fd + 1, &rfds, NULL, NULL, (timeout > 0) ? &tv : NULL);
|
||||
}
|
||||
|
||||
/*
|
||||
* Concatenates NULL-terminated list of arguments into a single
|
||||
* commmand and executes it
|
||||
* @param argv argument list
|
||||
* @param path NULL, ">output", or ">>output"
|
||||
* @param timeout seconds to wait before timing out or 0 for no timeout
|
||||
* @param ppid NULL to wait for child termination or pointer to pid
|
||||
* @return return value of executed command or errno
|
||||
*/
|
||||
int
|
||||
_eval(char *const argv[], char *path, int timeout, int *ppid)
|
||||
{
|
||||
pid_t pid;
|
||||
int status;
|
||||
int fd;
|
||||
int flags;
|
||||
int sig;
|
||||
char buf[254]="";
|
||||
int i;
|
||||
|
||||
switch (pid = fork()) {
|
||||
case -1: /* error */
|
||||
perror("fork");
|
||||
return errno;
|
||||
case 0: /* child */
|
||||
/* Reset signal handlers set for parent process */
|
||||
for (sig = 0; sig < (_NSIG-1); sig++)
|
||||
signal(sig, SIG_DFL);
|
||||
|
||||
/* Clean up */
|
||||
ioctl(0, TIOCNOTTY, 0);
|
||||
close(STDIN_FILENO);
|
||||
close(STDOUT_FILENO);
|
||||
close(STDERR_FILENO);
|
||||
setsid();
|
||||
|
||||
/* We want to check the board if exist UART? , add by honor 2003-12-04 */
|
||||
if ((fd = open("/dev/console", O_RDWR)) < 0) {
|
||||
(void) open("/dev/null", O_RDONLY);
|
||||
(void) open("/dev/null", O_WRONLY);
|
||||
(void) open("/dev/null", O_WRONLY);
|
||||
}
|
||||
else{
|
||||
close(fd);
|
||||
(void) open("/dev/console", O_RDONLY);
|
||||
(void) open("/dev/console", O_WRONLY);
|
||||
(void) open("/dev/console", O_WRONLY);
|
||||
}
|
||||
|
||||
/* Redirect stdout to <path> */
|
||||
if (path) {
|
||||
flags = O_WRONLY | O_CREAT;
|
||||
if (!strncmp(path, ">>", 2)) {
|
||||
/* append to <path> */
|
||||
flags |= O_APPEND;
|
||||
path += 2;
|
||||
} else if (!strncmp(path, ">", 1)) {
|
||||
/* overwrite <path> */
|
||||
flags |= O_TRUNC;
|
||||
path += 1;
|
||||
}
|
||||
if ((fd = open(path, flags, 0644)) < 0)
|
||||
perror(path);
|
||||
else {
|
||||
dup2(fd, STDOUT_FILENO);
|
||||
close(fd);
|
||||
}
|
||||
}
|
||||
|
||||
/* execute command */
|
||||
for(i=0 ; argv[i] ; i++)
|
||||
snprintf(buf+strlen(buf), sizeof(buf), "%s ", argv[i]);
|
||||
dprintf("cmd=[%s]\n", buf);
|
||||
setenv("PATH", "/sbin:/bin:/usr/sbin:/usr/bin", 1);
|
||||
alarm(timeout);
|
||||
execvp(argv[0], argv);
|
||||
perror(argv[0]);
|
||||
exit(errno);
|
||||
default: /* parent */
|
||||
if (ppid) {
|
||||
*ppid = pid;
|
||||
return 0;
|
||||
} else {
|
||||
waitpid(pid, &status, 0);
|
||||
if (WIFEXITED(status))
|
||||
return WEXITSTATUS(status);
|
||||
else
|
||||
return status;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* Concatenates NULL-terminated list of arguments into a single
|
||||
* commmand and executes it
|
||||
* @param argv argument list
|
||||
* @return stdout of executed command or NULL if an error occurred
|
||||
*/
|
||||
char *
|
||||
_backtick(char *const argv[])
|
||||
{
|
||||
int filedes[2];
|
||||
pid_t pid;
|
||||
int status;
|
||||
char *buf = NULL;
|
||||
|
||||
/* create pipe */
|
||||
if (pipe(filedes) == -1) {
|
||||
perror(argv[0]);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
switch (pid = fork()) {
|
||||
case -1: /* error */
|
||||
return NULL;
|
||||
case 0: /* child */
|
||||
close(filedes[0]); /* close read end of pipe */
|
||||
dup2(filedes[1], 1); /* redirect stdout to write end of pipe */
|
||||
close(filedes[1]); /* close write end of pipe */
|
||||
execvp(argv[0], argv);
|
||||
exit(errno);
|
||||
break;
|
||||
default: /* parent */
|
||||
close(filedes[1]); /* close write end of pipe */
|
||||
buf = fd2str(filedes[0]);
|
||||
waitpid(pid, &status, 0);
|
||||
break;
|
||||
}
|
||||
|
||||
return buf;
|
||||
}
|
||||
|
||||
/*
|
||||
* Kills process whose PID is stored in plaintext in pidfile
|
||||
* @param pidfile PID file
|
||||
* @return 0 on success and errno on failure
|
||||
*/
|
||||
int
|
||||
kill_pidfile(char *pidfile)
|
||||
{
|
||||
FILE *fp = fopen(pidfile, "r");
|
||||
char buf[256];
|
||||
|
||||
if (fp && fgets(buf, sizeof(buf), fp)) {
|
||||
pid_t pid = strtoul(buf, NULL, 0);
|
||||
fclose(fp);
|
||||
return kill(pid, SIGTERM);
|
||||
} else
|
||||
return errno;
|
||||
}
|
||||
|
||||
/*
|
||||
* fread() with automatic retry on syscall interrupt
|
||||
* @param ptr location to store to
|
||||
* @param size size of each element of data
|
||||
* @param nmemb number of elements
|
||||
* @param stream file stream
|
||||
* @return number of items successfully read
|
||||
*/
|
||||
int
|
||||
safe_fread(void *ptr, size_t size, size_t nmemb, FILE *stream)
|
||||
{
|
||||
size_t ret = 0;
|
||||
|
||||
do {
|
||||
clearerr(stream);
|
||||
ret += fread((char *)ptr + (ret * size), size, nmemb - ret, stream);
|
||||
} while (ret < nmemb && ferror(stream) && errno == EINTR);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*
|
||||
* fwrite() with automatic retry on syscall interrupt
|
||||
* @param ptr location to read from
|
||||
* @param size size of each element of data
|
||||
* @param nmemb number of elements
|
||||
* @param stream file stream
|
||||
* @return number of items successfully written
|
||||
*/
|
||||
int
|
||||
safe_fwrite(const void *ptr, size_t size, size_t nmemb, FILE *stream)
|
||||
{
|
||||
size_t ret = 0;
|
||||
|
||||
do {
|
||||
clearerr(stream);
|
||||
ret += fwrite((char *)ptr + (ret * size), size, nmemb - ret, stream);
|
||||
} while (ret < nmemb && ferror(stream) && errno == EINTR);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*
|
||||
* Convert Ethernet address string representation to binary data
|
||||
* @param a string in xx:xx:xx:xx:xx:xx notation
|
||||
* @param e binary data
|
||||
* @return TRUE if conversion was successful and FALSE otherwise
|
||||
*/
|
||||
int
|
||||
ether_atoe(const char *a, unsigned char *e)
|
||||
{
|
||||
char *c = (char *) a;
|
||||
int i = 0;
|
||||
|
||||
memset(e, 0, ETHER_ADDR_LEN);
|
||||
for (;;) {
|
||||
e[i++] = (unsigned char) strtoul(c, &c, 16);
|
||||
if (!*c++ || i == ETHER_ADDR_LEN)
|
||||
break;
|
||||
}
|
||||
return (i == ETHER_ADDR_LEN);
|
||||
}
|
||||
|
||||
/*
|
||||
* Convert Ethernet address binary data to string representation
|
||||
* @param e binary data
|
||||
* @param a string in xx:xx:xx:xx:xx:xx notation
|
||||
* @return a
|
||||
*/
|
||||
char *
|
||||
ether_etoa(const unsigned char *e, char *a)
|
||||
{
|
||||
char *c = a;
|
||||
int i;
|
||||
|
||||
for (i = 0; i < ETHER_ADDR_LEN; i++) {
|
||||
if (i)
|
||||
*c++ = ':';
|
||||
c += sprintf(c, "%02X", e[i] & 0xff);
|
||||
}
|
||||
return a;
|
||||
}
|
|
@ -1,356 +0,0 @@
|
|||
/*
|
||||
* Wireless network adapter utilities
|
||||
*
|
||||
* Copyright 2004, Broadcom Corporation
|
||||
* All Rights Reserved.
|
||||
*
|
||||
* THIS SOFTWARE IS OFFERED "AS IS", AND BROADCOM GRANTS NO WARRANTIES OF ANY
|
||||
* KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM
|
||||
* SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS
|
||||
* FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE.
|
||||
*
|
||||
* $Id$
|
||||
*/
|
||||
#include <stdio.h>
|
||||
#include <unistd.h>
|
||||
#include <string.h>
|
||||
#include <errno.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include <net/if.h>
|
||||
|
||||
#include <typedefs.h>
|
||||
#include <wlutils.h>
|
||||
|
||||
int
|
||||
wl_ioctl(char *name, int cmd, void *buf, int len)
|
||||
{
|
||||
struct ifreq ifr;
|
||||
wl_ioctl_t ioc;
|
||||
int ret = 0;
|
||||
int s;
|
||||
|
||||
/* open socket to kernel */
|
||||
if ((s = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
|
||||
perror("socket");
|
||||
return errno;
|
||||
}
|
||||
|
||||
/* do it */
|
||||
ioc.cmd = cmd;
|
||||
ioc.buf = buf;
|
||||
ioc.len = len;
|
||||
strncpy(ifr.ifr_name, name, IFNAMSIZ);
|
||||
ifr.ifr_data = (caddr_t) &ioc;
|
||||
if ((ret = ioctl(s, SIOCDEVPRIVATE, &ifr)) < 0)
|
||||
if (cmd != WLC_GET_MAGIC)
|
||||
perror(ifr.ifr_name);
|
||||
|
||||
/* cleanup */
|
||||
close(s);
|
||||
return ret;
|
||||
}
|
||||
|
||||
int
|
||||
wl_hwaddr(char *name, unsigned char *hwaddr)
|
||||
{
|
||||
struct ifreq ifr;
|
||||
int ret = 0;
|
||||
int s;
|
||||
|
||||
/* open socket to kernel */
|
||||
if ((s = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
|
||||
perror("socket");
|
||||
return errno;
|
||||
}
|
||||
|
||||
/* do it */
|
||||
strncpy(ifr.ifr_name, name, IFNAMSIZ);
|
||||
if ((ret = ioctl(s, SIOCGIFHWADDR, &ifr)) == 0)
|
||||
memcpy(hwaddr, ifr.ifr_hwaddr.sa_data, ETHER_ADDR_LEN);
|
||||
|
||||
/* cleanup */
|
||||
close(s);
|
||||
return ret;
|
||||
}
|
||||
|
||||
int
|
||||
wl_probe(char *name)
|
||||
{
|
||||
int ret, val;
|
||||
|
||||
/* Check interface */
|
||||
if ((ret = wl_ioctl(name, WLC_GET_MAGIC, &val, sizeof(val))))
|
||||
return ret;
|
||||
if (val != WLC_IOCTL_MAGIC)
|
||||
return -1;
|
||||
if ((ret = wl_ioctl(name, WLC_GET_VERSION, &val, sizeof(val))))
|
||||
return ret;
|
||||
if (val > WLC_IOCTL_VERSION)
|
||||
return -1;
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int
|
||||
wl_set_val(char *name, char *var, void *val, int len)
|
||||
{
|
||||
char buf[128];
|
||||
int buf_len;
|
||||
|
||||
/* check for overflow */
|
||||
if ((buf_len = strlen(var)) + 1 + len > sizeof(buf))
|
||||
return -1;
|
||||
|
||||
strcpy(buf, var);
|
||||
buf_len += 1;
|
||||
|
||||
/* append int value onto the end of the name string */
|
||||
memcpy(&buf[buf_len], val, len);
|
||||
buf_len += len;
|
||||
|
||||
return wl_ioctl(name, WLC_SET_VAR, buf, buf_len);
|
||||
}
|
||||
|
||||
int
|
||||
wl_get_val(char *name, char *var, void *val, int len)
|
||||
{
|
||||
char buf[128];
|
||||
int ret;
|
||||
|
||||
/* check for overflow */
|
||||
if (strlen(var) + 1 > sizeof(buf) || len > sizeof(buf))
|
||||
return -1;
|
||||
|
||||
strcpy(buf, var);
|
||||
if ((ret = wl_ioctl(name, WLC_GET_VAR, buf, sizeof(buf))))
|
||||
return ret;
|
||||
|
||||
memcpy(val, buf, len);
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
wl_set_int(char *name, char *var, int val)
|
||||
{
|
||||
return wl_set_val(name, var, &val, sizeof(val));
|
||||
}
|
||||
|
||||
int
|
||||
wl_get_int(char *name, char *var, int *val)
|
||||
{
|
||||
return wl_get_val(name, var, val, sizeof(*val));
|
||||
}
|
||||
|
||||
/**************************************************************************
|
||||
* The following code is from Broadcom (wl.c) *
|
||||
**************************************************************************/
|
||||
|
||||
int
|
||||
wl_iovar_getbuf(char *ifname, char *iovar, void *param,
|
||||
int paramlen, void *bufptr, int buflen)
|
||||
{
|
||||
int err;
|
||||
uint namelen;
|
||||
uint iolen;
|
||||
|
||||
namelen = strlen(iovar) + 1; /* length of iovar name plus null */
|
||||
iolen = namelen + paramlen;
|
||||
|
||||
/* check for overflow */
|
||||
if (iolen > buflen)
|
||||
return (-1);
|
||||
|
||||
memcpy(bufptr, iovar, namelen); /* copy iovar name including null */
|
||||
memcpy((int8*)bufptr + namelen, param, paramlen);
|
||||
|
||||
err = wl_ioctl(ifname, WLC_GET_VAR, bufptr, buflen);
|
||||
|
||||
return (err);
|
||||
}
|
||||
|
||||
int
|
||||
wl_iovar_setbuf(char *ifname, char *iovar, void *param,
|
||||
int paramlen, void *bufptr, int buflen)
|
||||
{
|
||||
uint namelen;
|
||||
uint iolen;
|
||||
|
||||
namelen = strlen(iovar) + 1; /* length of iovar name plus null */
|
||||
iolen = namelen + paramlen;
|
||||
|
||||
/* check for overflow */
|
||||
if (iolen > buflen)
|
||||
return (-1);
|
||||
|
||||
memcpy(bufptr, iovar, namelen); /* copy iovar name including null */
|
||||
memcpy((int8*)bufptr + namelen, param, paramlen);
|
||||
|
||||
return wl_ioctl(ifname, WLC_SET_VAR, bufptr, iolen);
|
||||
}
|
||||
|
||||
int
|
||||
wl_iovar_set(char *ifname, char *iovar, void *param, int paramlen)
|
||||
{
|
||||
char smbuf[WLC_IOCTL_SMLEN];
|
||||
|
||||
return wl_iovar_setbuf(ifname, iovar, param, paramlen, smbuf, sizeof(smbuf));
|
||||
}
|
||||
|
||||
int
|
||||
wl_iovar_get(char *ifname, char *iovar, void *bufptr, int buflen)
|
||||
{
|
||||
char smbuf[WLC_IOCTL_SMLEN];
|
||||
int ret;
|
||||
|
||||
/* use the return buffer if it is bigger than what we have on the stack */
|
||||
if (buflen > sizeof(smbuf)) {
|
||||
ret = wl_iovar_getbuf(ifname, iovar, NULL, 0, bufptr, buflen);
|
||||
} else {
|
||||
ret = wl_iovar_getbuf(ifname, iovar, NULL, 0, smbuf, sizeof(smbuf));
|
||||
if (ret == 0)
|
||||
memcpy(bufptr, smbuf, buflen);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*
|
||||
* set named driver variable to int value
|
||||
* calling example: wl_iovar_setint(ifname, "arate", rate)
|
||||
*/
|
||||
int
|
||||
wl_iovar_setint(char *ifname, char *iovar, int val)
|
||||
{
|
||||
return wl_iovar_set(ifname, iovar, &val, sizeof(val));
|
||||
}
|
||||
|
||||
/*
|
||||
* get named driver variable to int value and return error indication
|
||||
* calling example: wl_iovar_getint(ifname, "arate", &rate)
|
||||
*/
|
||||
int
|
||||
wl_iovar_getint(char *ifname, char *iovar, int *val)
|
||||
{
|
||||
return wl_iovar_get(ifname, iovar, val, sizeof(int));
|
||||
}
|
||||
|
||||
/*
|
||||
* format a bsscfg indexed iovar buffer
|
||||
*/
|
||||
static int
|
||||
wl_bssiovar_mkbuf(char *iovar, int bssidx, void *param,
|
||||
int paramlen, void *bufptr, int buflen, int *plen)
|
||||
{
|
||||
char *prefix = "bsscfg:";
|
||||
int8* p;
|
||||
uint prefixlen;
|
||||
uint namelen;
|
||||
uint iolen;
|
||||
|
||||
prefixlen = strlen(prefix); /* length of bsscfg prefix */
|
||||
namelen = strlen(iovar) + 1; /* length of iovar name + null */
|
||||
iolen = prefixlen + namelen + sizeof(int) + paramlen;
|
||||
|
||||
/* check for overflow */
|
||||
if (buflen < 0 || iolen > (uint)buflen) {
|
||||
*plen = 0;
|
||||
return -1;
|
||||
}
|
||||
|
||||
p = (int8*)bufptr;
|
||||
|
||||
/* copy prefix, no null */
|
||||
memcpy(p, prefix, prefixlen);
|
||||
p += prefixlen;
|
||||
|
||||
/* copy iovar name including null */
|
||||
memcpy(p, iovar, namelen);
|
||||
p += namelen;
|
||||
|
||||
/* bss config index as first param */
|
||||
memcpy(p, &bssidx, sizeof(int32));
|
||||
p += sizeof(int32);
|
||||
|
||||
/* parameter buffer follows */
|
||||
if (paramlen)
|
||||
memcpy(p, param, paramlen);
|
||||
|
||||
*plen = iolen;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* set named & bss indexed driver variable to buffer value
|
||||
*/
|
||||
int
|
||||
wl_bssiovar_setbuf(char *ifname, char *iovar, int bssidx, void *param,
|
||||
int paramlen, void *bufptr, int buflen)
|
||||
{
|
||||
int err;
|
||||
uint iolen;
|
||||
|
||||
err = wl_bssiovar_mkbuf(iovar, bssidx, param, paramlen, bufptr, buflen, &iolen);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
return wl_ioctl(ifname, WLC_SET_VAR, bufptr, iolen);
|
||||
}
|
||||
|
||||
/*
|
||||
* get named & bss indexed driver variable buffer value
|
||||
*/
|
||||
int
|
||||
wl_bssiovar_getbuf(char *ifname, char *iovar, int bssidx, void *param,
|
||||
int paramlen, void *bufptr, int buflen)
|
||||
{
|
||||
int err;
|
||||
uint iolen;
|
||||
|
||||
err = wl_bssiovar_mkbuf(iovar, bssidx, param, paramlen, bufptr, buflen, &iolen);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
return wl_ioctl(ifname, WLC_GET_VAR, bufptr, buflen);
|
||||
}
|
||||
|
||||
/*
|
||||
* set named & bss indexed driver variable to buffer value
|
||||
*/
|
||||
int
|
||||
wl_bssiovar_set(char *ifname, char *iovar, int bssidx, void *param, int paramlen)
|
||||
{
|
||||
char smbuf[WLC_IOCTL_SMLEN];
|
||||
|
||||
return wl_bssiovar_setbuf(ifname, iovar, bssidx, param, paramlen, smbuf, sizeof(smbuf));
|
||||
}
|
||||
|
||||
/*
|
||||
* get named & bss indexed driver variable buffer value
|
||||
*/
|
||||
int
|
||||
wl_bssiovar_get(char *ifname, char *iovar, int bssidx, void *outbuf, int len)
|
||||
{
|
||||
char smbuf[WLC_IOCTL_SMLEN];
|
||||
int err;
|
||||
|
||||
/* use the return buffer if it is bigger than what we have on the stack */
|
||||
if (len > (int)sizeof(smbuf)) {
|
||||
err = wl_bssiovar_getbuf(ifname, iovar, bssidx, NULL, 0, outbuf, len);
|
||||
} else {
|
||||
memset(smbuf, 0, sizeof(smbuf));
|
||||
err = wl_bssiovar_getbuf(ifname, iovar, bssidx, NULL, 0, smbuf, sizeof(smbuf));
|
||||
if (err == 0)
|
||||
memcpy(outbuf, smbuf, len);
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/*
|
||||
* set named & bss indexed driver variable to int value
|
||||
*/
|
||||
int
|
||||
wl_bssiovar_setint(char *ifname, char *iovar, int bssidx, int val)
|
||||
{
|
||||
return wl_bssiovar_set(ifname, iovar, bssidx, &val, sizeof(int));
|
||||
}
|
Loading…
Reference in New Issue