int svrapp::on_timer(int event, int interval, void * ptr){
switch(event){
case ev_keepalive_timer:
send_keepalive();
break;
case ev_cmd_poll_timer:
cmd_poll();
break;
case ev_report_server_infor_timer:
report_to_web();
break;
}
add_timer(event, interval, ptr);
return 0;
}
int main(void)
{
int i;
rcc_clock_setup_in_hsi_out_48mhz();
debug_init();
printf("Device UP!\nFW version %s\n", FW_VERSION);
cmd_init();
CMD_REGISTER_LIST(main_cmds);
init_modules();
printf("Init complete..\n");
while (1) {
cmd_poll();
}
}
int main(int argc, char *argv[])
{
int opt;
int do_follow, do_file, do_promisc;
int do_get_aa, do_set_aa;
int do_crc;
int do_adv_index;
int do_slave_mode;
int do_target;
char ubertooth_device = -1;
btle_options cb_opts = { .allowed_access_address_errors = 32 };
int r;
u32 access_address;
uint8_t mac_address[6] = { 0, };
do_follow = do_file = 0, do_promisc = 0;
do_get_aa = do_set_aa = 0;
do_crc = -1; // 0 and 1 mean set, 2 means get
do_adv_index = 37;
do_slave_mode = do_target = 0;
while ((opt=getopt(argc,argv,"a::r:d:hfpi:U:v::A:s:t:x:c:q:")) != EOF) {
switch(opt) {
case 'a':
if (optarg == NULL) {
do_get_aa = 1;
} else {
do_set_aa = 1;
sscanf(optarg, "%08x", &access_address);
}
break;
case 'f':
do_follow = 1;
break;
case 'p':
do_promisc = 1;
break;
case 'i':
do_file = 1;
infile = fopen(optarg, "r");
if (infile == NULL) {
printf("Could not open file %s\n", optarg);
usage();
return 1;
}
break;
case 'U':
ubertooth_device = atoi(optarg);
break;
case 'r':
if (!h_pcapng_le) {
if (lell_pcapng_create_file(optarg, "Ubertooth", &h_pcapng_le)) {
err(1, "lell_pcapng_create_file: ");
}
}
else {
printf("Ignoring extra capture file: %s\n", optarg);
}
break;
#ifdef ENABLE_PCAP
case 'q':
if (!h_pcap_le) {
if (lell_pcap_create_file(optarg, &h_pcap_le)) {
err(1, "lell_pcap_create_file: ");
}
}
else {
printf("Ignoring extra capture file: %s\n", optarg);
}
break;
case 'c':
if (!h_pcap_le) {
if (lell_pcap_ppi_create_file(optarg, 0, &h_pcap_le)) {
err(1, "lell_pcap_ppi_create_file: ");
}
}
else {
printf("Ignoring extra capture file: %s\n", optarg);
}
break;
#endif
case 'd':
dumpfile = fopen(optarg, "w");
if (dumpfile == NULL) {
perror(optarg);
return 1;
}
break;
case 'v':
if (optarg)
do_crc = atoi(optarg) ? 1 : 0;
else
do_crc = 2; // get
break;
case 'A':
do_adv_index = atoi(optarg);
if (do_adv_index < 37 || do_adv_index > 39) {
printf("Error: advertising index must be 37, 38, or 39\n");
usage();
return 1;
}
break;
case 's':
do_slave_mode = 1;
r = convert_mac_address(optarg, mac_address);
if (!r) {
usage();
return 1;
}
break;
case 't':
do_target = 1;
r = convert_mac_address(optarg, mac_address);
if (!r) {
usage();
return 1;
}
break;
case 'x':
cb_opts.allowed_access_address_errors = (unsigned) atoi(optarg);
if (cb_opts.allowed_access_address_errors > 32) {
printf("Error: can tolerate 0-32 access address bit errors\n");
usage();
return 1;
}
break;
case 'h':
default:
usage();
return 1;
}
}
if (do_file) {
rx_btle_file(infile);
fclose(infile);
return 0; // do file is the only command that doesn't open ubertooth
}
devh = ubertooth_start(ubertooth_device);
if (devh == NULL) {
usage();
return 1;
}
/* Clean up on exit. */
signal(SIGINT, cleanup);
signal(SIGQUIT, cleanup);
signal(SIGTERM, cleanup);
if (do_follow || do_promisc) {
usb_pkt_rx pkt;
cmd_set_modulation(devh, MOD_BT_LOW_ENERGY);
if (do_follow) {
u16 channel;
if (do_adv_index == 37)
channel = 2402;
else if (do_adv_index == 38)
channel = 2426;
else
channel = 2480;
cmd_set_channel(devh, channel);
cmd_btle_sniffing(devh, 2);
} else {
cmd_btle_promisc(devh);
}
while (1) {
int r = cmd_poll(devh, &pkt);
if (r < 0) {
printf("USB error\n");
break;
}
if (r == sizeof(usb_pkt_rx))
cb_btle(&cb_opts, &pkt, 0);
usleep(500);
}
ubertooth_stop(devh);
}
if (do_get_aa) {
access_address = cmd_get_access_address(devh);
printf("Access address: %08x\n", access_address);
return 0;
}
if (do_set_aa) {
cmd_set_access_address(devh, access_address);
printf("access address set to: %08x\n", access_address);
}
if (do_crc >= 0) {
int r;
if (do_crc == 2) {
r = cmd_get_crc_verify(devh);
} else {
cmd_set_crc_verify(devh, do_crc);
r = do_crc;
}
printf("CRC: %sverify\n", r ? "" : "DO NOT ");
}
if (do_slave_mode) {
u16 channel;
if (do_adv_index == 37)
channel = 2402;
else if (do_adv_index == 38)
channel = 2426;
else
channel = 2480;
cmd_set_channel(devh, channel);
cmd_btle_slave(devh, mac_address);
}
if (do_target) {
r = cmd_btle_set_target(devh, mac_address);
if (r == 0) {
int i;
printf("target set to: ");
for (i = 0; i < 5; ++i)
printf("%02x:", mac_address[i]);
printf("%02x\n", mac_address[5]);
}
}
return 0;
}
int
deliver_pipe_deliver(struct deliver_ctx *dctx, struct actitem *ti)
{
struct account *a = dctx->account;
struct mail *m = dctx->mail;
struct deliver_pipe_data *data = ti->data;
char *s, *cause, *err;
int status;
struct cmd *cmd = NULL;
char *lbuf;
size_t llen;
s = replacepath(&data->cmd, m->tags, m, &m->rml, dctx->udata->home);
if (s == NULL || *s == '\0') {
log_warnx("%s: empty command", a->name);
goto error;
}
if (data->pipe) {
log_debug2("%s: piping to \"%s\"", a->name, s);
cmd = cmd_start(s, CMD_IN|CMD_ONCE, m->data, m->size, &cause);
} else {
log_debug2("%s: executing \"%s\"", a->name, s);
cmd = cmd_start(s, 0, NULL, 0, &cause);
}
if (cmd == NULL)
goto error_cause;
log_debug3("%s: %s: started", a->name, s);
llen = IO_LINESIZE;
lbuf = xmalloc(llen);
do {
status = cmd_poll(
cmd, NULL, &err, &lbuf, &llen, conf.timeout, &cause);
if (status == -1) {
xfree(lbuf);
goto error_cause;
}
if (status == 0 && err != NULL)
log_warnx("%s: %s: %s", a->name, s, err);
} while (status == 0);
status--;
xfree(lbuf);
if (status != 0) {
log_warnx("%s: %s: command returned %d", a->name, s, status);
goto error;
}
cmd_free(cmd);
xfree(s);
return (DELIVER_SUCCESS);
error_cause:
log_warnx("%s: %s: %s", a->name, s, cause);
xfree(cause);
error:
if (cmd != NULL)
cmd_free(cmd);
if (s != NULL)
xfree(s);
return (DELIVER_FAILURE);
}
/**
* The periodic function, this is called by the main loop periodically
*
* It polls the clipboard for commands and the chatlog for new text
*
*/
void apme_periodic(void)
{
cmd_poll();
chatlog_poll();
cfg_periodic();
}
int main(int argc, char *argv[])
{
errorCode_t ec;
char **adpArray = NULL;
int adpLen;
neardal_adapter *adapter;
static int power = 1;
g_argc=argc;
g_argv=argv;
printf("\n");
/* Look for available adapter */
ec = neardal_get_adapters(&adpArray, &adpLen);
if (ec == NEARDAL_SUCCESS)
{
memcpy(AdpName, adpArray[0], sizeof(AdpName));
neardal_free_array(&adpArray);
} else
{
printf("---- No adapter found\n");
return 1;
}
/* Power on first adapter found */
ec = neardal_get_adapter_properties(AdpName,&adapter);
if (ec == NEARDAL_SUCCESS)
{
power=adapter->powered;
neardal_free_adapter(adapter);
if (!power)
{
power = 1;
ec = neardal_set_adapter_property(AdpName, NEARD_ADP_PROP_POWERED, GINT_TO_POINTER(power));
if (ec != NEARDAL_SUCCESS) {
printf("---- Error setting adapter properties\n");
return 1;
}
}
} else
{
printf("---- Error getting adapter properties\n");
return 1;
}
/* Register callbacks */
neardal_set_cb_tag_found(cb_tag_found, NULL);
neardal_set_cb_tag_lost(cb_tag_lost, NULL);
neardal_set_cb_dev_found(cb_dev_found, NULL);
neardal_set_cb_dev_lost(cb_dev_lost, NULL);
if (argc<2)
{
printf("Missing argument\n");
help();
}
else if (strcmp(argv[1],"poll") == 0)
{
neardal_agent_set_NDEF_cb("urn:nfc:wkt:U", cb_ndef_agent, NULL, NULL);
neardal_set_cb_record_found(cb_record_found, NULL);
cmd_poll();
}
else if(strcmp(argv[1],"write") == 0)
{
cmd_write(g_argc,g_argv);
}
else if(strcmp(argv[1],"push") == 0)
{
cmd_push(g_argc,g_argv);
}
else
{
help();
}
printf("\n");
return 0;
}
void
child_deliver_cmd_hook(pid_t pid, struct account *a, unused struct msg *msg,
struct child_deliver_data *data, int *result)
{
struct mail_ctx *mctx = data->mctx;
struct mail *m = data->mail;
struct match_command_data *cmddata = data->cmddata;
int flags, status, found = 0;
char *s, *cause, *lbuf, *out, *err, tag[24];
size_t llen;
struct cmd *cmd = NULL;
struct rmlist rml;
u_int i;
/* If this is the parent, do nothing. */
if (pid != 0) {
xfree(mctx);
return;
}
/* Sort out the command. */
s = replacepath(
&cmddata->cmd, m->tags, m, &m->rml, find_tag(m->tags, "home"));
if (s == NULL || *s == '\0') {
log_warnx("%s: empty command", a->name);
goto error;
}
log_debug2("%s: %s: started (ret=%d re=%s)", a->name, s, cmddata->ret,
cmddata->re.str == NULL ? "none" : cmddata->re.str);
flags = CMD_ONCE;
if (cmddata->pipe)
flags |= CMD_IN;
if (cmddata->re.str != NULL)
flags |= CMD_OUT;
cmd = cmd_start(s, flags, m->data, m->size, &cause);
if (cmd == NULL) {
log_warnx("%s: %s: %s", a->name, s, cause);
goto error;
}
llen = IO_LINESIZE;
lbuf = xmalloc(llen);
for (;;) {
/* Stop early if looking for regexp only. */
if (found && cmddata->ret == -1) {
log_debug3("%s: %s: found. stopping early", a->name, s);
status = 1;
break;
}
status = cmd_poll(
cmd, &out, &err, &lbuf, &llen, conf.timeout, &cause);
if (status == -1) {
log_warnx("%s: %s: %s", a->name, s, cause);
goto error;
}
if (status != 0)
break;
if (err != NULL)
log_warnx("%s: %s: %s", a->name, s, err);
if (out == NULL)
continue;
log_debug3("%s: %s: out: %s", a->name, s, out);
if (found)
continue;
found = re_string(&cmddata->re, out, &rml, &cause);
if (found == -1) {
log_warnx("%s: %s", a->name, cause);
goto error;
}
if (found != 1)
continue;
/* Save the matches. */
if (!rml.valid)
continue;
for (i = 0; i < NPMATCH; i++) {
if (!rml.list[i].valid)
break;
xsnprintf(tag, sizeof tag, "command%u", i);
add_tag(&m->tags, tag, "%.*s", (int) (rml.list[i].eo -
rml.list[i].so), out + rml.list[i].so);
}
}
status--;
log_debug2("%s: %s: returned %d, found %d", a->name, s, status, found);
cmd_free(cmd);
xfree(s);
xfree(lbuf);
status = cmddata->ret == status;
if (cmddata->ret != -1 && cmddata->re.str != NULL)
*result = (found && status) ? MATCH_TRUE : MATCH_FALSE;
else if (cmddata->ret != -1 && cmddata->re.str == NULL)
*result = status ? MATCH_TRUE : MATCH_FALSE;
else if (cmddata->ret == -1 && cmddata->re.str != NULL)
*result = found ? MATCH_TRUE : MATCH_FALSE;
else
*result = MATCH_ERROR;
return;
error:
if (cause != NULL)
xfree(cause);
if (cmd != NULL)
cmd_free(cmd);
if (s != NULL)
xfree(s);
if (lbuf != NULL)
xfree(lbuf);
*result = MATCH_ERROR;
}
int main(int argc, char *argv[])
{
int opt;
int do_follow, do_promisc;
int do_get_aa, do_set_aa;
int do_crc;
int do_adv_index;
int do_slave_mode;
int do_target;
enum jam_modes jam_mode = JAM_NONE;
char ubertooth_device = -1;
ubertooth_t* ut = ubertooth_init();
btle_options cb_opts = { .allowed_access_address_errors = 32 };
int r;
u32 access_address;
uint8_t mac_address[6] = { 0, };
do_follow = do_promisc = 0;
do_get_aa = do_set_aa = 0;
do_crc = -1; // 0 and 1 mean set, 2 means get
do_adv_index = 37;
do_slave_mode = do_target = 0;
while ((opt=getopt(argc,argv,"a::r:hfpU:v::A:s:t:x:c:q:jJiI")) != EOF) {
switch(opt) {
case 'a':
if (optarg == NULL) {
do_get_aa = 1;
} else {
do_set_aa = 1;
sscanf(optarg, "%08x", &access_address);
}
break;
case 'f':
do_follow = 1;
break;
case 'p':
do_promisc = 1;
break;
case 'U':
ubertooth_device = atoi(optarg);
break;
case 'r':
if (!ut->h_pcapng_le) {
if (lell_pcapng_create_file(optarg, "Ubertooth", &ut->h_pcapng_le)) {
err(1, "lell_pcapng_create_file: ");
}
}
else {
printf("Ignoring extra capture file: %s\n", optarg);
}
break;
#ifdef ENABLE_PCAP
case 'q':
if (!ut->h_pcap_le) {
if (lell_pcap_create_file(optarg, &ut->h_pcap_le)) {
err(1, "lell_pcap_create_file: ");
}
}
else {
printf("Ignoring extra capture file: %s\n", optarg);
}
break;
case 'c':
if (!ut->h_pcap_le) {
if (lell_pcap_ppi_create_file(optarg, 0, &ut->h_pcap_le)) {
err(1, "lell_pcap_ppi_create_file: ");
}
}
else {
printf("Ignoring extra capture file: %s\n", optarg);
}
break;
#endif
case 'v':
if (optarg)
do_crc = atoi(optarg) ? 1 : 0;
else
do_crc = 2; // get
break;
case 'A':
do_adv_index = atoi(optarg);
if (do_adv_index < 37 || do_adv_index > 39) {
printf("Error: advertising index must be 37, 38, or 39\n");
usage();
return 1;
}
break;
case 's':
do_slave_mode = 1;
r = convert_mac_address(optarg, mac_address);
if (!r) {
usage();
return 1;
}
break;
case 't':
do_target = 1;
r = convert_mac_address(optarg, mac_address);
if (!r) {
usage();
return 1;
}
break;
case 'x':
cb_opts.allowed_access_address_errors = (unsigned) atoi(optarg);
if (cb_opts.allowed_access_address_errors > 32) {
printf("Error: can tolerate 0-32 access address bit errors\n");
usage();
return 1;
}
break;
case 'i':
case 'j':
jam_mode = JAM_ONCE;
break;
case 'I':
case 'J':
jam_mode = JAM_CONTINUOUS;
break;
case 'h':
default:
usage();
return 1;
}
}
r = ubertooth_connect(ut, ubertooth_device);
if (r < 0) {
usage();
return 1;
}
/* Clean up on exit. */
register_cleanup_handler(ut);
if (do_follow && do_promisc) {
printf("Error: must choose either -f or -p, one or the other pal\n");
return 1;
}
if (do_follow || do_promisc) {
usb_pkt_rx rx;
r = cmd_set_jam_mode(ut->devh, jam_mode);
if (jam_mode != JAM_NONE && r != 0) {
printf("Jamming not supported\n");
return 1;
}
cmd_set_modulation(ut->devh, MOD_BT_LOW_ENERGY);
if (do_follow) {
u16 channel;
if (do_adv_index == 37)
channel = 2402;
else if (do_adv_index == 38)
channel = 2426;
else
channel = 2480;
cmd_set_channel(ut->devh, channel);
cmd_btle_sniffing(ut->devh, 2);
} else {
cmd_btle_promisc(ut->devh);
}
while (1) {
int r = cmd_poll(ut->devh, &rx);
if (r < 0) {
printf("USB error\n");
break;
}
if (r == sizeof(usb_pkt_rx)) {
ringbuffer_add(ut->packets, &rx);
cb_btle(ut, &cb_opts);
}
usleep(500);
}
ubertooth_stop(ut);
}
if (do_get_aa) {
access_address = cmd_get_access_address(ut->devh);
printf("Access address: %08x\n", access_address);
return 0;
}
if (do_set_aa) {
cmd_set_access_address(ut->devh, access_address);
printf("access address set to: %08x\n", access_address);
}
if (do_crc >= 0) {
int r;
if (do_crc == 2) {
r = cmd_get_crc_verify(ut->devh);
} else {
cmd_set_crc_verify(ut->devh, do_crc);
r = do_crc;
}
printf("CRC: %sverify\n", r ? "" : "DO NOT ");
}
if (do_slave_mode) {
u16 channel;
if (do_adv_index == 37)
channel = 2402;
else if (do_adv_index == 38)
channel = 2426;
else
channel = 2480;
cmd_set_channel(ut->devh, channel);
cmd_btle_slave(ut->devh, mac_address);
}
if (do_target) {
r = cmd_btle_set_target(ut->devh, mac_address);
if (r == 0) {
int i;
printf("target set to: ");
for (i = 0; i < 5; ++i)
printf("%02x:", mac_address[i]);
printf("%02x\n", mac_address[5]);
}
}
if (!(do_follow || do_promisc || do_get_aa || do_set_aa ||
do_crc >= 0 || do_slave_mode || do_target))
usage();
return 0;
}
int main(int argc, char *argv[])
{
int opt;
int do_mode = -1;
int do_channel = 2418;
char ubertooth_device = -1;
int r;
while ((opt=getopt(argc,argv,"frijc:U:h")) != EOF) {
switch(opt) {
case 'f':
do_mode = 0;
break;
case 'r':
do_mode = 1;
break;
case 'i':
case 'j':
do_mode = 2; // TODO take care of these magic numbers
break;
case 'c':
do_channel = atoi(optarg);
break;
case 'U':
ubertooth_device = atoi(optarg);
break;
case 'h':
default:
usage();
return 1;
}
}
ut = ubertooth_start(ubertooth_device);
if (ut == NULL) {
usage();
return 1;
}
/* Clean up on exit. */
register_cleanup_handler(ut);
if (do_mode >= 0) {
usb_pkt_rx rx;
if (do_mode == 1) // FIXME magic number!
cmd_set_channel(ut->devh, do_channel);
r = cmd_ego(ut->devh, do_mode);
if (r < 0) {
if (do_mode == 0 || do_mode == 1)
printf("Error: E-GO not supported by this firmware\n");
else
printf("Error: E-GO not supported by this firmware (or TX not enabled)\n");
return 1;
}
while (1) {
int r = cmd_poll(ut->devh, &rx);
if (r < 0) {
printf("USB error\n");
break;
}
if (r == sizeof(usb_pkt_rx)) {
ringbuffer_add(ut->packets, &rx);
cb_ego(ut, NULL);
}
usleep(500);
}
ubertooth_stop(ut);
}
return 0;
}
