122 lines
3.9 KiB
C
122 lines
3.9 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"
|
|
|
|
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_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 *context) {
|
|
skipstone_message *message;
|
|
|
|
if (((uint8_t *)buf)[0] == 0x08) {
|
|
message = skipstone_message_new();
|
|
skipstone_message_append_uint8(message, 0x10);
|
|
skipstone_message_append_string(message, "KMFDM", 5);
|
|
skipstone_message_append_string(message, "Nihil", 5);
|
|
skipstone_message_append_string(message, "Ultra", 5);
|
|
skipstone_message_append_uint32(message, htobe32(274));
|
|
skipstone_message_append_uint16(message, htobe16(10));
|
|
skipstone_message_append_uint16(message, htobe16(1));
|
|
skipstone_message_service_queue(service, message, 32);
|
|
skipstone_message_destroy(message);
|
|
|
|
message = skipstone_message_new();
|
|
skipstone_message_append_uint8(message, 0x11);
|
|
skipstone_message_append_uint8(message, 1);
|
|
skipstone_message_append_uint32(message, htobe32(120));
|
|
skipstone_message_append_uint32(message, htobe32(1));
|
|
skipstone_message_append_uint8(message, 1);
|
|
skipstone_message_append_uint8(message, 1);
|
|
skipstone_message_service_queue(service, message, 32);
|
|
skipstone_message_destroy(message);
|
|
|
|
message = skipstone_message_new();
|
|
skipstone_message_append_uint8(message, 0x13);
|
|
skipstone_message_append_string(message, "DeaDBeeF", 8);
|
|
skipstone_message_append_string(message, "DeaDBeeF", 8);
|
|
skipstone_message_service_queue(service, message, 32);
|
|
skipstone_message_destroy(message);
|
|
} else {
|
|
printf("Got playback command %02x\n", ((uint8_t *)buf)[0]);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int main(int argc, char **argv) {
|
|
skipstone_link *link;
|
|
skipstone_message_service *service;
|
|
|
|
if (argc != 2) {
|
|
usage(argc, argv);
|
|
}
|
|
|
|
if ((link = skipstone_link_open_serial(argv[1])) == NULL) {
|
|
perror("skipstone_link_open_serial()");
|
|
goto error_link_open;
|
|
}
|
|
|
|
if ((service = skipstone_message_service_new()) == NULL) {
|
|
perror("skipstone_message_service_new()");
|
|
goto error_message_service_new;
|
|
}
|
|
|
|
skipstone_message_service_register(service, 17, answer_phone_version_message, NULL);
|
|
skipstone_message_service_register(service, 32, answer_music_message, NULL);
|
|
|
|
time_t start = time(NULL);
|
|
int done = 0;
|
|
|
|
while (1) {
|
|
struct timeval timeout = {
|
|
.tv_sec = 0,
|
|
.tv_usec = 50000
|
|
};
|
|
|
|
if (skipstone_message_service_next_event(service, link, &timeout) < 0) {
|
|
perror("skipstone_message_service_next_event()");
|
|
|
|
goto error_io;
|
|
}
|
|
|
|
if (!done && time(NULL) - start >= 10) {
|
|
skipstone_message *message = skipstone_message_new();
|
|
skipstone_message_append_uint8(message, 4);
|
|
skipstone_message_append_uint32(message, htobe32(0xdeadbeef));
|
|
skipstone_message_append_string(message, "+19004206969", 12);
|
|
skipstone_message_append_string(message, "XANTRONIX ehf", 13);
|
|
skipstone_message_service_queue(service, message, 0x21);
|
|
skipstone_message_destroy(message);
|
|
|
|
done = 1;
|
|
}
|
|
}
|
|
|
|
skipstone_link_close(link);
|
|
|
|
return 0;
|
|
|
|
error_io:
|
|
error_message_service_new:
|
|
skipstone_link_close(link);
|
|
|
|
error_link_open:
|
|
return 1;
|
|
}
|