152 lines
4.5 KiB
C
152 lines
4.5 KiB
C
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <time.h>
|
|
|
|
#include <skipstone/link.h>
|
|
#include <skipstone/message.h>
|
|
#include <skipstone/system.h>
|
|
|
|
#include "../src/util.h"
|
|
|
|
struct context {
|
|
skipstone_link *link;
|
|
};
|
|
|
|
static void usage(int argc, char **argv) {
|
|
fprintf(stderr, "usage: %s /dev/rfcommX\n", argv[0]);
|
|
exit(1);
|
|
}
|
|
|
|
static int answer_phone_version_message(skipstone_message_service *service,
|
|
void *buf,
|
|
uint16_t size,
|
|
uint16_t id,
|
|
void *context) {
|
|
const uint32_t flags = SKIPSTONE_SYSTEM_CLIENT_TELEPHONY
|
|
| SKIPSTONE_SYSTEM_CLIENT_SMS
|
|
| SKIPSTONE_SYSTEM_CLIENT_ANDROID;
|
|
|
|
return skipstone_system_send_client_version(service, flags);
|
|
}
|
|
|
|
static int answer_music_message(skipstone_message_service *service,
|
|
void *buf,
|
|
uint16_t size,
|
|
uint16_t id,
|
|
void *ctx) {
|
|
struct context *context = ctx;
|
|
|
|
uint8_t message[256];
|
|
ssize_t len;
|
|
|
|
if (((uint8_t *)buf)[0] == 0x08) {
|
|
if ((len = skipstone_message_pack(message,
|
|
sizeof(message),
|
|
"CzzzLSS",
|
|
0x10,
|
|
"KMFDM",
|
|
"Nihil",
|
|
"Ultra")) < 0) {
|
|
goto error_message_pack;
|
|
}
|
|
|
|
if (skipstone_link_send(context->link, message, 32, len) < 0) {
|
|
goto error_link_send;
|
|
}
|
|
|
|
if ((len = skipstone_message_pack(message,
|
|
sizeof(message),
|
|
"CCLLCC",
|
|
0x11,
|
|
1,
|
|
htole32(120),
|
|
htole32(120),
|
|
htole32(320),
|
|
1,
|
|
1)) < 0) {
|
|
goto error_message_pack;
|
|
}
|
|
|
|
if (skipstone_link_send(context->link, message, 32, len) < 0) {
|
|
goto error_link_send;
|
|
}
|
|
|
|
if ((len = skipstone_message_pack(message,
|
|
sizeof(message),
|
|
"Czz",
|
|
0x13,
|
|
"DeaDBeeF",
|
|
"DeaDBeeF")) < 0) {
|
|
goto error_message_pack;
|
|
}
|
|
|
|
if (skipstone_link_send(context->link, message, 32, len) < 0) {
|
|
goto error_link_send;
|
|
}
|
|
} else {
|
|
printf("Got playback command %02x\n", ((uint8_t *)buf)[0]);
|
|
}
|
|
|
|
return 0;
|
|
|
|
error_link_send:
|
|
error_message_pack:
|
|
return -1;
|
|
}
|
|
|
|
static int answer_phone_message(skipstone_message_service *service,
|
|
void *buf,
|
|
uint16_t size,
|
|
uint16_t id,
|
|
void *context) {
|
|
printf("Got phone command %02x\n", ((uint8_t *)buf)[0]);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int main(int argc, char **argv) {
|
|
skipstone_link *link;
|
|
skipstone_message_service *service;
|
|
|
|
struct context context;
|
|
|
|
if (argc != 2) {
|
|
usage(argc, argv);
|
|
}
|
|
|
|
if ((link = skipstone_link_open(argv[1])) == NULL) {
|
|
perror("skipstone_link_open()");
|
|
goto error_link_open;
|
|
}
|
|
|
|
if ((service = skipstone_message_service_new(link)) == NULL) {
|
|
perror("skipstone_message_service_new()");
|
|
goto error_message_service_new;
|
|
}
|
|
|
|
context.link = link;
|
|
|
|
skipstone_message_service_register(service, 17, answer_phone_version_message, &context);
|
|
skipstone_message_service_register(service, 32, answer_music_message, &context);
|
|
skipstone_message_service_register(service, 33, answer_phone_message, &context);
|
|
|
|
while (1) {
|
|
if (skipstone_message_service_event_handle(service) < 0) {
|
|
perror("skipstone_message_service_event_handle()");
|
|
|
|
goto error_io;
|
|
}
|
|
}
|
|
|
|
skipstone_link_close(link);
|
|
|
|
return 0;
|
|
|
|
error_io:
|
|
error_message_service_new:
|
|
skipstone_link_close(link);
|
|
|
|
error_link_open:
|
|
return 1;
|
|
}
|