2018-02-08 11:26:31 +01:00
|
|
|
#include "controller.h"
|
2017-12-14 11:38:44 +01:00
|
|
|
|
2018-08-15 16:45:22 +02:00
|
|
|
#include <SDL2/SDL_assert.h>
|
2019-03-02 23:52:22 +01:00
|
|
|
|
2018-08-15 16:45:22 +02:00
|
|
|
#include "config.h"
|
2018-08-15 17:01:54 +02:00
|
|
|
#include "lock_util.h"
|
2018-02-13 10:10:18 +01:00
|
|
|
#include "log.h"
|
2017-12-14 11:38:44 +01:00
|
|
|
|
2019-03-02 23:52:22 +01:00
|
|
|
bool
|
2019-05-28 21:03:54 +02:00
|
|
|
controller_init(struct controller *controller, socket_t control_socket) {
|
2019-05-29 21:24:30 +02:00
|
|
|
cbuf_init(&controller->queue);
|
2017-12-14 11:38:44 +01:00
|
|
|
|
2019-05-30 00:25:37 +02:00
|
|
|
if (!receiver_init(&controller->receiver, control_socket)) {
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2017-12-14 11:38:44 +01:00
|
|
|
if (!(controller->mutex = SDL_CreateMutex())) {
|
2019-05-30 00:25:37 +02:00
|
|
|
receiver_destroy(&controller->receiver);
|
2019-03-02 23:52:22 +01:00
|
|
|
return false;
|
2017-12-14 11:38:44 +01:00
|
|
|
}
|
|
|
|
|
2019-05-31 14:55:11 +02:00
|
|
|
if (!(controller->msg_cond = SDL_CreateCond())) {
|
2019-05-30 00:25:37 +02:00
|
|
|
receiver_destroy(&controller->receiver);
|
2017-12-14 11:38:44 +01:00
|
|
|
SDL_DestroyMutex(controller->mutex);
|
2019-03-02 23:52:22 +01:00
|
|
|
return false;
|
2017-12-14 11:38:44 +01:00
|
|
|
}
|
|
|
|
|
2019-05-28 21:03:54 +02:00
|
|
|
controller->control_socket = control_socket;
|
2019-03-02 23:52:22 +01:00
|
|
|
controller->stopped = false;
|
2017-12-14 11:38:44 +01:00
|
|
|
|
2019-03-02 23:52:22 +01:00
|
|
|
return true;
|
2017-12-14 11:38:44 +01:00
|
|
|
}
|
|
|
|
|
2019-03-02 20:09:56 +01:00
|
|
|
void
|
|
|
|
controller_destroy(struct controller *controller) {
|
2019-05-31 14:55:11 +02:00
|
|
|
SDL_DestroyCond(controller->msg_cond);
|
2017-12-14 11:38:44 +01:00
|
|
|
SDL_DestroyMutex(controller->mutex);
|
2019-05-29 21:24:30 +02:00
|
|
|
|
2019-05-31 14:55:11 +02:00
|
|
|
struct control_msg msg;
|
|
|
|
while (cbuf_take(&controller->queue, &msg)) {
|
|
|
|
control_msg_destroy(&msg);
|
2019-05-29 21:24:30 +02:00
|
|
|
}
|
2019-05-30 00:25:37 +02:00
|
|
|
|
|
|
|
receiver_destroy(&controller->receiver);
|
2017-12-14 11:38:44 +01:00
|
|
|
}
|
|
|
|
|
2019-03-02 23:52:22 +01:00
|
|
|
bool
|
2019-05-31 14:55:11 +02:00
|
|
|
controller_push_msg(struct controller *controller,
|
|
|
|
const struct control_msg *msg) {
|
2017-12-14 11:38:44 +01:00
|
|
|
mutex_lock(controller->mutex);
|
2019-05-29 21:24:30 +02:00
|
|
|
bool was_empty = cbuf_is_empty(&controller->queue);
|
2019-05-31 14:55:11 +02:00
|
|
|
bool res = cbuf_push(&controller->queue, *msg);
|
2017-12-14 11:38:44 +01:00
|
|
|
if (was_empty) {
|
2019-05-31 14:55:11 +02:00
|
|
|
cond_signal(controller->msg_cond);
|
2017-12-14 11:38:44 +01:00
|
|
|
}
|
|
|
|
mutex_unlock(controller->mutex);
|
|
|
|
return res;
|
|
|
|
}
|
|
|
|
|
2019-03-02 23:52:22 +01:00
|
|
|
static bool
|
2019-05-31 14:55:11 +02:00
|
|
|
process_msg(struct controller *controller,
|
|
|
|
const struct control_msg *msg) {
|
|
|
|
unsigned char serialized_msg[CONTROL_MSG_SERIALIZED_MAX_SIZE];
|
|
|
|
int length = control_msg_serialize(msg, serialized_msg);
|
2017-12-14 11:38:44 +01:00
|
|
|
if (!length) {
|
2019-03-02 23:52:22 +01:00
|
|
|
return false;
|
2017-12-14 11:38:44 +01:00
|
|
|
}
|
2019-05-31 14:55:11 +02:00
|
|
|
int w = net_send_all(controller->control_socket, serialized_msg, length);
|
2017-12-14 11:38:44 +01:00
|
|
|
return w == length;
|
|
|
|
}
|
|
|
|
|
2019-03-02 20:09:56 +01:00
|
|
|
static int
|
|
|
|
run_controller(void *data) {
|
2017-12-14 11:38:44 +01:00
|
|
|
struct controller *controller = data;
|
|
|
|
|
|
|
|
for (;;) {
|
2018-05-26 15:14:46 +02:00
|
|
|
mutex_lock(controller->mutex);
|
2019-05-29 21:24:30 +02:00
|
|
|
while (!controller->stopped && cbuf_is_empty(&controller->queue)) {
|
2019-05-31 14:55:11 +02:00
|
|
|
cond_wait(controller->msg_cond, controller->mutex);
|
2017-12-14 11:38:44 +01:00
|
|
|
}
|
|
|
|
if (controller->stopped) {
|
2019-05-31 14:55:11 +02:00
|
|
|
// stop immediately, do not process further msgs
|
2018-05-26 15:14:46 +02:00
|
|
|
mutex_unlock(controller->mutex);
|
2017-12-14 11:38:44 +01:00
|
|
|
break;
|
|
|
|
}
|
2019-05-31 14:55:11 +02:00
|
|
|
struct control_msg msg;
|
|
|
|
bool non_empty = cbuf_take(&controller->queue, &msg);
|
2018-05-26 15:14:46 +02:00
|
|
|
SDL_assert(non_empty);
|
|
|
|
mutex_unlock(controller->mutex);
|
|
|
|
|
2019-05-31 14:55:11 +02:00
|
|
|
bool ok = process_msg(controller, &msg);
|
|
|
|
control_msg_destroy(&msg);
|
2018-05-26 15:14:46 +02:00
|
|
|
if (!ok) {
|
2019-06-23 20:49:38 +02:00
|
|
|
LOGD("Could not write msg to socket");
|
2018-05-26 15:14:46 +02:00
|
|
|
break;
|
2017-12-14 11:38:44 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2019-03-02 23:52:22 +01:00
|
|
|
bool
|
2019-03-02 20:09:56 +01:00
|
|
|
controller_start(struct controller *controller) {
|
2018-02-13 10:10:18 +01:00
|
|
|
LOGD("Starting controller thread");
|
2017-12-14 11:38:44 +01:00
|
|
|
|
2019-03-02 20:09:56 +01:00
|
|
|
controller->thread = SDL_CreateThread(run_controller, "controller",
|
|
|
|
controller);
|
2017-12-14 11:38:44 +01:00
|
|
|
if (!controller->thread) {
|
2018-02-13 10:10:18 +01:00
|
|
|
LOGC("Could not start controller thread");
|
2019-03-02 23:52:22 +01:00
|
|
|
return false;
|
2017-12-14 11:38:44 +01:00
|
|
|
}
|
|
|
|
|
2019-05-30 00:25:37 +02:00
|
|
|
if (!receiver_start(&controller->receiver)) {
|
|
|
|
controller_stop(controller);
|
|
|
|
SDL_WaitThread(controller->thread, NULL);
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2019-03-02 23:52:22 +01:00
|
|
|
return true;
|
2017-12-14 11:38:44 +01:00
|
|
|
}
|
|
|
|
|
2019-03-02 20:09:56 +01:00
|
|
|
void
|
|
|
|
controller_stop(struct controller *controller) {
|
2017-12-14 11:38:44 +01:00
|
|
|
mutex_lock(controller->mutex);
|
2019-03-02 23:52:22 +01:00
|
|
|
controller->stopped = true;
|
2019-05-31 14:55:11 +02:00
|
|
|
cond_signal(controller->msg_cond);
|
2017-12-14 11:38:44 +01:00
|
|
|
mutex_unlock(controller->mutex);
|
|
|
|
}
|
|
|
|
|
2019-03-02 20:09:56 +01:00
|
|
|
void
|
|
|
|
controller_join(struct controller *controller) {
|
2017-12-14 11:38:44 +01:00
|
|
|
SDL_WaitThread(controller->thread, NULL);
|
2019-05-30 00:25:37 +02:00
|
|
|
receiver_join(&controller->receiver);
|
2017-12-14 11:38:44 +01:00
|
|
|
}
|