-
Notifications
You must be signed in to change notification settings - Fork 6
Expand file tree
/
Copy pathviperfx_intf.c
More file actions
64 lines (54 loc) · 1.63 KB
/
viperfx_intf.c
File metadata and controls
64 lines (54 loc) · 1.63 KB
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
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
#include <stdlib.h>
#include <stdint.h>
#include <string.h>
#include "viperfx_intf.h"
int viperfx_command_set_px4_vx4x1 (viperfx_interface * intf,
int32_t param, int32_t value)
{
int32_t cmd_data[3];
cmd_data[0] = param;
cmd_data[1] = sizeof(int32_t);
cmd_data[2] = value;
return (!intf->command (intf, COMMAND_CODE_SET,
sizeof(cmd_data), cmd_data, NULL, NULL));
}
int viperfx_command_set_px4_vx4x2 (viperfx_interface * intf,
int32_t param, int32_t value_l, int32_t value_h)
{
int32_t cmd_data[4];
cmd_data[0] = param;
cmd_data[1] = sizeof(int32_t) << 1;
cmd_data[2] = value_l;
cmd_data[3] = value_h;
return (!intf->command (intf, COMMAND_CODE_SET,
sizeof(cmd_data), cmd_data, NULL, NULL));
}
int viperfx_command_set_px4_vx4x3 (viperfx_interface * intf,
int32_t param, int32_t value_l, int32_t value_h, int32_t value_e)
{
int32_t cmd_data[5];
cmd_data[0] = param;
cmd_data[1] = sizeof(int32_t) * 3;
cmd_data[2] = value_l;
cmd_data[3] = value_h;
cmd_data[4] = value_e;
return (!intf->command (intf, COMMAND_CODE_SET,
sizeof(cmd_data), cmd_data, NULL, NULL));
}
int viperfx_command_set_ir_path (viperfx_interface * intf,
const char * pathname)
{
char cmd_data[4 + 256];
int32_t * cmd_data_int = (int32_t *)cmd_data;
int32_t pathlen = (int32_t) strlen(pathname);
if (pathlen >= 256)
return FALSE;
memset (cmd_data, 0, sizeof(cmd_data));
cmd_data_int[0] = PARAM_HPFX_CONV_UPDATEKERNEL;
cmd_data_int[1] = 256;
cmd_data_int[2] = pathlen;
memcpy (&cmd_data_int[3],
pathname, pathlen);
return (!intf->command (intf, COMMAND_CODE_SET,
sizeof(cmd_data), cmd_data, NULL, NULL));
}