Newer
Older
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <err.h>
#include <inttypes.h>
#include "frontend_override.h"
/* Set the override state of outputs
*
* Returns 0 on success, 1 on error
*/
int frontend_setoutputoverride(
struct backend_conn * conn,
struct frontend_override_data * values) {
char msg[64] = "";
int written;
snprintf(msg, 64, "outputoverride %" PRId8 " %f %f %f %f\n",
values->enable,
values->throttle, values->pitch, values->roll, values->yaw);
if((written = ucart_backendWrite(conn, msg)) < 0) {
return 1;
}
size_t pendingResponses = 0;
char * response;
while (pendingResponses) {
response = ucart_backendGetline(conn);
if (response == NULL) {
warnx("Line not returned from backend");
return 1;
}
}
return 0;
}