#include <sys/types.h>
#include <sys/queue.h>
#include <sys/socket.h>
#include <net/if.h>
#include <net/ethernet.h>
#include <assert.h>
#include <bluetooth.h>
#include <stdbool.h>
#include <stdlib.h>
#include <string.h>
#include <syslog.h>
#include "event.h"
#ifndef __arraycount
#define __arraycount(__x) (int)(sizeof((__x)) / sizeof((__x)[0]))
#endif
#ifndef L2CAP_PSM_INVALID
#define L2CAP_PSM_INVALID(psm) (((psm) & 0x0101) != 0x0001)
#endif
#ifndef L2CAP_PSM_BNEP
#define L2CAP_PSM_BNEP 15
#endif
typedef struct channel channel_t;
typedef struct pfilter pfilter_t;
typedef struct mfilter mfilter_t;
typedef struct packet packet_t;
typedef struct pkthdr pkthdr_t;
typedef struct pktlist pktlist_t;
typedef struct exthdr exthdr_t;
typedef struct extlist extlist_t;
LIST_HEAD(chlist, channel);
STAILQ_HEAD(extlist, exthdr);
STAILQ_HEAD(pktlist, pkthdr);
enum channel_state {
CHANNEL_CLOSED,
CHANNEL_WAIT_CONNECT_REQ,
CHANNEL_WAIT_CONNECT_RSP,
CHANNEL_OPEN,
};
#define CHANNEL_MAXQLEN 128
struct channel {
enum channel_state state;
bool oactive;
uint8_t laddr[ETHER_ADDR_LEN];
uint8_t raddr[ETHER_ADDR_LEN];
size_t mru;
size_t mtu;
int npfilter;
pfilter_t * pfilter;
int nmfilter;
mfilter_t * mfilter;
pktlist_t pktlist;
int qlen;
int fd;
struct event rd_ev;
struct event wr_ev;
uint8_t * sendbuf;
bool (*send)(channel_t *, packet_t *);
bool (*recv)(packet_t *);
int tick;
struct pidfh *pfh;
int refcnt;
LIST_ENTRY(channel) next;
};
struct pfilter {
uint16_t start;
uint16_t end;
};
struct mfilter {
uint8_t start[ETHER_ADDR_LEN];
uint8_t end[ETHER_ADDR_LEN];
};
struct packet {
channel_t * chan;
uint8_t * dst;
uint8_t * src;
uint8_t * type;
uint8_t * ptr;
size_t len;
int refcnt;
extlist_t extlist;
uint8_t buf[0];
};
struct exthdr {
STAILQ_ENTRY(exthdr) next;
uint8_t * ptr;
uint8_t len;
};
struct pkthdr {
STAILQ_ENTRY(pkthdr) next;
packet_t * data;
};
extern const char * control_path;
extern const char * service_name;
extern const char * interface_name;
extern bdaddr_t local_bdaddr;
extern bdaddr_t remote_bdaddr;
extern uint16_t l2cap_psm;
extern int l2cap_mode;
extern uint16_t service_class;
extern int server_limit;
static inline void
b2eaddr(void *dst, bdaddr_t *src)
{
uint8_t *d = dst;
int i;
for (i = 0; i < ETHER_ADDR_LEN; i++)
d[i] = src->b[ETHER_ADDR_LEN - i - 1];
}
#define log_err(fmt, args...) syslog(LOG_ERR, fmt , ##args)
#define log_info(fmt, args...) syslog(LOG_INFO, fmt , ##args)
#define log_notice(fmt, args...) syslog(LOG_NOTICE, fmt , ##args)
#define log_debug(fmt, args...) syslog(LOG_DEBUG, "%s: " fmt, __func__ , ##args)
bool bnep_send(channel_t *, packet_t *);
bool bnep_recv(packet_t *);
void bnep_send_control(channel_t *, unsigned, ...);
void channel_init(void);
channel_t * channel_alloc(void);
bool channel_open(channel_t *, int);
void channel_close(channel_t *);
void channel_free(channel_t *);
void channel_timeout(channel_t *, int);
void channel_put(channel_t *, packet_t *);
void client_init(void);
packet_t * packet_alloc(channel_t *);
void packet_free(packet_t *);
void packet_adj(packet_t *, size_t);
pkthdr_t * pkthdr_alloc(packet_t *);
void pkthdr_free(pkthdr_t *);
void server_init(void);
void server_update(int);
void tap_init(void);