int main(int argc, char *argv[]) {
char *uart_port = "";
// シグナルハンドラの登録
if (signal(SIGINT, handler) == SIG_ERR)
return 1;
// 引数が不足しているかのチェック
if (argc <= CLARG_PORT) {
usage(argv[0]);
return 1;
}
// COM ポート引数のチェック
if (argc > CLARG_PORT) {
if (strcmp(argv[CLARG_PORT], "list") == 0) {
uart_list_devices(); // デバイスのリスト表示
return 1;
}
else {
uart_port = argv[CLARG_PORT];
}
}
// アクション引数のチェック
if (argc > CLARG_ACTION) {
int i;
for (i = 0; i < strlen(argv[CLARG_ACTION]); i++) {
// 小文字にしておく
argv[CLARG_ACTION][i] = tolower(argv[CLARG_ACTION][i]);
}
if (strcmp(argv[CLARG_ACTION], "scan") == 0) {
action = action_scan; // スキャン
} else if (strcmp(argv[CLARG_ACTION], "info") == 0) {
action = action_info; // デバイス情報の表示
} else {
}
}
if (action == action_none) {
usage(argv[0]);
return 1;
}
bglib_output = output;
// COMポートのオープン
if (uart_open(uart_port)) {
printf("ERROR: Unable to open serial port\n");
return 1;
}
// BLED のリセット
ble_cmd_system_reset(0);
uart_close();
do {
// usleep(500000); // 0.5s
Sleep(500); // 0.5s
} while (uart_open(uart_port));
// アクションの実行
if (action == action_scan) {
// [1] スキャンの開始
ble_cmd_gap_discover(gap_discover_observation);
} else if (action == action_info) {
// [2] デバイスの情報表示の要求
ble_cmd_system_get_info();
} else {
return 1;
}
// メッセージループ
while (state != state_finish) {
if (read_message(UART_TIMEOUT) > 0) break;
}
// COMポートのクローズ
uart_close();
return 0;
}
int main(int argc, char *argv[])
{
pthread_t threads[2];
send_port = recv_port = 0;
char *uart_port = "";
gettimeofday(&tm, NULL);
old_time = (double)tm.tv_sec + (double)tm.tv_usec / 1000000.0;
//ble_cmd_sm_set_bondable_mode(1);
host = (struct hostent *) gethostbyname((char *)"127.0.0.1");
// Not enough command-line arguments
if (argc <= CLARG_PORT) {
usage(argv[0]);
return 1;
}
// COM port argument
if (argc > CLARG_PORT) {
if (strcmp(argv[CLARG_PORT], "list") == 0) {
uart_list_devices();
return 1;
} else if (strcmp(argv[CLARG_PORT], "-h") == 0 || strcmp(argv[CLARG_PORT], "--help") == 0) {
usage(argv[0]);
} else {
uart_port = argv[CLARG_PORT];
}
}
// Action argument
if (argc > CLARG_ACTION) {
int i;
for (i = 0; i < strlen(argv[CLARG_ACTION]); i++) {
argv[CLARG_ACTION][i] = tolower(argv[CLARG_ACTION][i]);
}
if (strcmp(argv[CLARG_ACTION], "scan") == 0) {
action = action_scan;
} else if (strcmp(argv[CLARG_ACTION], "info") == 0) {
action = action_info;
} else if (strcmp(argv[CLARG_ACTION], "broadcast") == 0 || strcmp(argv[CLARG_ACTION], "broadcast_connect") == 0) {
action = action_broadcast;
if (argc > CLARG_ACTION + 2) {
send_port = atoi(argv[CLARG_ACTION + 1]);
recv_port = atoi(argv[CLARG_ACTION + 2]);
} else {
usage(argv[0]);
return 1;
}
if (strcmp(argv[CLARG_ACTION], "broadcast_connect") == 0) {
connect_all = 1;
action = action_broadcast_connect;
}
} else if (strcmp(argv[CLARG_ACTION], "all") == 0) {
connect_all = 1;
action = action_scan;
if (argc > CLARG_ACTION + 2) {
send_port = atoi(argv[CLARG_ACTION + 1]);
recv_port = atoi(argv[CLARG_ACTION + 2]);
} else {
usage(argv[0]);
return 1;
}
} else {
int i;
short unsigned int addr[6];
if (sscanf(argv[CLARG_ACTION],
"%02hx:%02hx:%02hx:%02hx:%02hx:%02hx",
&addr[5],
&addr[4],
&addr[3],
&addr[2],
&addr[1],
&addr[0]) == 6) {
for (i = 0; i < 6; i++) {
connect_addr.addr[i] = addr[i];
}
action = action_connect;
if (argc > CLARG_ACTION + 2) {
send_port = atoi(argv[CLARG_ACTION + 1]);
recv_port = atoi(argv[CLARG_ACTION + 2]);
} else {
usage(argv[0]);
return 1;
}
}
}
}
if (action == action_none) {
usage(argv[0]);
return 1;
}
size_t i = 0;
for (i = 0; i < argc; i++)
{
if(strcmp(argv[i],"log") == 0){
time_t timev;
time(&timev);
char timedate[256];
strftime(timedate, 256, "var/logs/%Y%m%d_%H%M%S.rssilog", localtime(&timev));
rssi_fp = fopen(timedate, "w");
if (!rssi_fp)
{
fprintf(stderr,"Unable to open file for logging: %s\n Make sure to run from paparazzi home\n", timedate);
return -1;
}
}
}
// set BGLib output function pointer to "send_api_packet" function
bglib_output = send_api_packet;
if (uart_open(uart_port)) {
fprintf(stderr, "ERROR: Unable to open serial port - %s\n", strerror(errno));
return 1;
}
// Reset dongle to get it into known state
ble_cmd_system_reset(0);
#if 0 // very soft "reset"
// close current connection, stop scanning, stop advertising
// (returns BLE device to a known state without a hard reset)
ble_cmd_connection_disconnect(0);
ble_cmd_gap_set_mode(0, 0);
ble_cmd_gap_end_procedure();
#else // full reset
// reset BLE device to get it into known state
ble_cmd_system_reset(0);
// close the serial port, since reset causes USB to re-enumerate
uart_close();
// wait until USB re-enumerates and we can re-open the port
// (not necessary if using a direct UART connection)
do {
usleep(500000); // 0.5s
} while (uart_open(uart_port));
#endif
// get the mac address of the dongle
ble_cmd_system_address_get();
// advertise interval scales 625us, min, max, channels (0x07 = 3, 0x03 = 2, 0x04 = 1)
if (action == action_broadcast)
ble_cmd_gap_set_adv_parameters(0x20, 0x28, 0x07);
// Execute action
if (action == action_scan || action == action_broadcast || action == action_broadcast_connect) {
ble_cmd_gap_discover(gap_discover_generic);
} else if (action == action_info) {
ble_cmd_system_get_info();
} else if (action == action_connect) {
fprintf(stderr, "Trying to connect\n");
change_state(state_connecting);
ble_cmd_gap_connect_direct(&connect_addr, gap_address_type_public, 8, 16, 100, 0);
}
pthread_create(&threads[0], NULL, send_msg, NULL);
pthread_create(&threads[1], NULL, recv_paparazzi_comms, NULL);
// Message loop
while (state != state_finish) {
if (read_api_packet(UART_TIMEOUT) > 0) { break; }
}
change_state(state_finish);
ble_cmd_gap_end_procedure();
uart_close();
pthread_exit(NULL);
if (rssi_fp)
fclose(rssi_fp);
}
int main(int argc, char *argv[])
{
// signal(SIGINT, intHandler);
pthread_t threads[3];
send_port = recv_port = 0;
char *uart_port = "";
gettimeofday(&tm, NULL);
old_time = (double)tm.tv_sec + (double)tm.tv_usec / 1000000.0;
//ble_cmd_sm_set_bondable_mode(1);
host = (struct hostent *) gethostbyname((char *)"127.0.0.1");
// Not enough command-line arguments
if (argc <= CLARG_PORT) {
usage(argv[0]);
return 1;
}
// COM port argument
if (argc > CLARG_PORT) {
if (strcmp(argv[CLARG_PORT], "list") == 0) {
uart_list_devices();
return 1;
} else if (strcmp(argv[CLARG_PORT], "-h") == 0 || strcmp(argv[CLARG_PORT], "--help") == 0) {
usage(argv[0]);
} else {
uart_port = argv[CLARG_PORT];
}
}
// Action argument
if (argc > CLARG_ACTION) {
int i;
for (i = 0; i < strlen(argv[CLARG_ACTION]); i++) {
argv[CLARG_ACTION][i] = tolower(argv[CLARG_ACTION][i]);
}
if (strcmp(argv[CLARG_ACTION], "scan") == 0) {
action = action_scan;
} else if (strcmp(argv[CLARG_ACTION], "info") == 0) {
action = action_info;
} else if (strcmp(argv[CLARG_ACTION], "broadcast") == 0) {
action = action_broadcast;
if (argc > CLARG_ACTION + 2) {
send_port = atoi(argv[CLARG_ACTION + 1]);
recv_port = atoi(argv[CLARG_ACTION + 2]);
} else {
usage(argv[0]);
return 1;
}
} else if (strcmp(argv[CLARG_ACTION], "all") == 0) {
connect_all = 1;
action = action_scan;
if (argc > CLARG_ACTION + 2) {
send_port = atoi(argv[CLARG_ACTION + 1]);
recv_port = atoi(argv[CLARG_ACTION + 2]);
} else {
usage(argv[0]);
return 1;
}
} else {
int i;
short unsigned int addr[6];
if (sscanf(argv[CLARG_ACTION],
"%02hx:%02hx:%02hx:%02hx:%02hx:%02hx",
&addr[5],
&addr[4],
&addr[3],
&addr[2],
&addr[1],
&addr[0]) == 6) {
for (i = 0; i < 6; i++) {
connect_addr.addr[i] = addr[i];
}
action = action_connect;
if (argc > CLARG_ACTION + 2) {
send_port = atoi(argv[CLARG_ACTION + 1]);
recv_port = atoi(argv[CLARG_ACTION + 2]);
} else {
usage(argv[0]);
return 1;
}
}
}
}
if (action == action_none) {
usage(argv[0]);
return 1;
}
bglib_output = output;
if (uart_open(uart_port)) {
fprintf(stderr,"ERROR: Unable to open serial port - %s\n", strerror(errno));
return 1;
}
// Reset dongle to get it into known state
ble_cmd_system_reset(0);
uart_close();
do {
usleep(500000); // 0.5s
} while (uart_open(uart_port));
// start read thread
pthread_create(&threads[0], NULL, read_message, NULL);
// get the mac address of the dongle
ble_cmd_system_address_get();
// Execute action
if (action == action_scan) {
ble_cmd_gap_discover(gap_discover_generic);
} else if (action == action_info) {
ble_cmd_system_get_info();
} else if (action == action_connect) {
fprintf(stderr,"Trying to connect\n");
change_state(state_connecting);
ble_cmd_gap_connect_direct(&connect_addr, gap_address_type_public, 8, 16, 100, 0);
} else if (action == action_broadcast) {
ble_cmd_gap_set_adv_parameters(0x200, 0x200,
0x07); // advertise interval scales 625us, min, max, channels (0x07 = 3, 0x03 = 2, 0x04 = 1)
}
pthread_create(&threads[1], NULL, send_msg, NULL);
pthread_create(&threads[2], NULL, recv_paparazzi_comms, NULL);
// Message loop
while (state != state_finish) {
// if (kbhit()) {
// getchar();
// break;
// }
usleep(1000);
}
change_state(state_finish);
ble_cmd_gap_end_procedure();
uart_close();
pthread_exit(NULL);
}
