skipstone/examples/test.c-e

94 lines
3 KiB
Text

#include <stdio.h>
#include <stdlib.h>
#include <string.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);
}
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);
skipstone_message_service_run(service, link);
perror("skipstone_message_service_run()");
skipstone_link_close(link);
return 0;
error_message_service_new:
skipstone_link_close(link);
error_link_open:
return 1;
}