Subversion Repositories Projects

Rev

Rev 140 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
130 ligi 1
#include "config.h"
2
 
483 ligi 3
 
130 ligi 4
 
5
char *input_evdev_name;
140 ligi 6
char *input_joydev_name;
130 ligi 7
 
8
char *bluetooth_mac;
483 ligi 9
char *mk_tty;
130 ligi 10
 
11
int  mk_socket_port=0;
12
int  loop_delay=0;
13
 
14
double nick_mul=0.3f;
15
double roll_mul=0.3f;
16
double gier_mul=0.3f;
17
double gas_mul=0.3f;
18
 
19
 
140 ligi 20
double nick_add=0.3f;
21
double roll_add=0.3f;
22
double gier_add=0.3f;
23
double gas_add=0.3f;
24
 
483 ligi 25
int rel_axis_nick;
26
int rel_axis_roll;
27
int rel_axis_gier;
28
int rel_axis_gas;
140 ligi 29
 
483 ligi 30
cfg_bool_t exit_after_init = cfg_false;
130 ligi 31
 
32
 
483 ligi 33
int input_count=0;
130 ligi 34
 
35
int parse_config(char* fname)
36
{
37
 
38
 
483 ligi 39
  static cfg_opt_t input_opts[] = {
40
    CFG_STR("name", 0, CFGF_NONE),    
41
 
42
    CFG_FLOAT("nick_mul", 1.0,CFGF_NONE),
43
    CFG_FLOAT("roll_mul", 1.0,CFGF_NONE),
44
    CFG_FLOAT("gier_mul", 1.0,CFGF_NONE),
45
    CFG_FLOAT("gas_mul", 1.0,CFGF_NONE),
46
 
47
    CFG_FLOAT("nick_add", 0,CFGF_NONE),
48
    CFG_FLOAT("roll_add", 0,CFGF_NONE),
49
    CFG_FLOAT("gier_add", 0,CFGF_NONE),
50
    CFG_FLOAT("gas_add", 0,CFGF_NONE),
51
 
52
    CFG_INT("rel_axis_nick",  -1,CFGF_NONE),
53
    CFG_INT("rel_axis_roll",  -1,CFGF_NONE),
54
    CFG_INT("rel_axis_gier",  -1,CFGF_NONE),
55
    CFG_INT("rel_axis_gas", -1,CFGF_NONE),
56
 
57
    CFG_INT("nick_up_btn",  -1,CFGF_NONE),
58
    CFG_INT("nick_down_btn",  -1,CFGF_NONE),
59
    CFG_INT("roll_left_btn",  -1,CFGF_NONE),
60
    CFG_INT("roll_right_btn", -1,CFGF_NONE),
61
 
62
 
63
 
64
 
65
 
66
 
67
    CFG_END()
68
  };
69
 
130 ligi 70
  cfg_opt_t opts[] = {
483 ligi 71
    CFG_SEC("input", input_opts, CFGF_MULTI | CFGF_TITLE),
130 ligi 72
    CFG_SIMPLE_STR("bluetooth_mac", &bluetooth_mac),    
73
 
483 ligi 74
    CFG_SIMPLE_STR("mk_tty", &mk_tty),    
75
 
130 ligi 76
    CFG_SIMPLE_BOOL("exit_after_init", &exit_after_init),
77
    CFG_SIMPLE_STR("input_evdev", &input_evdev_name),
140 ligi 78
    CFG_SIMPLE_STR("input_joydev", &input_joydev_name),
130 ligi 79
    CFG_SIMPLE_INT("loop_delay", &loop_delay),
80
    CFG_SIMPLE_INT("mk_socket_port", &mk_socket_port),
81
 
82
    CFG_SIMPLE_FLOAT("nick_mul", &nick_mul),
83
    CFG_SIMPLE_FLOAT("roll_mul", &roll_mul),
84
    CFG_SIMPLE_FLOAT("gier_mul", &gier_mul),
85
    CFG_SIMPLE_FLOAT("gas_mul", &gas_mul),
140 ligi 86
 
87
    CFG_SIMPLE_FLOAT("nick_add", &nick_add),
88
    CFG_SIMPLE_FLOAT("roll_add", &roll_add),
89
    CFG_SIMPLE_FLOAT("gier_add", &gier_add),
90
    CFG_SIMPLE_FLOAT("gas_add", &gas_add),
130 ligi 91
 
92
    CFG_SIMPLE_INT("rel_axis_nick", &rel_axis_nick),
93
    CFG_SIMPLE_INT("rel_axis_roll", &rel_axis_roll),
94
    CFG_SIMPLE_INT("rel_axis_gier", &rel_axis_gier),
95
    CFG_SIMPLE_INT("rel_axis_gas", &rel_axis_gas),
96
 
97
    CFG_END()
98
  };
99
 
100
  cfg_t *cfg;
101
 
102
 
103
  printf("Parsing config file %s\n",fname);
104
 
105
  cfg = cfg_init(opts, 0);
106
 
107
  cfg_parse(cfg,fname);
108
 
109
 
483 ligi 110
  input_count=cfg_size(cfg,"input");
111
 
112
  printf("%d inputs configured\n", input_count);
113
  int i;
114
  int act_input=0;
115
  for (i=0;i<input_count;i++)
116
    {
117
      cfg_t *input_sect=cfg_getnsec(cfg,"input",i);
118
 
119
 
120
      printf("processing input: %s\n",cfg_getstr( input_sect, "name"));
121
      int evdev_i=0;
122
 
123
      for (evdev_i=0;evdev_i<evdevs_count;evdev_i++)
124
        if (!strcmp(cfg_getstr( input_sect, "name"),evdevs[evdev_i].name))
125
          {
126
            sprintf( inputs[act_input].fname,"%s",evdevs[evdev_i].fname);
127
 
128
            // todo check lengt
129
            sprintf(inputs[act_input].name,"processing input: %s\n",cfg_getstr( input_sect, "name"));
130
 
131
            inputs[act_input].nick_mul=cfg_getfloat(input_sect,"nick_mul");
132
            inputs[act_input].roll_mul=cfg_getfloat(input_sect,"roll_mul");
133
            inputs[act_input].gier_mul=cfg_getfloat(input_sect,"gier_mul");
134
            inputs[act_input].gas_mul=cfg_getfloat(input_sect,"gas_mul");
135
 
136
            inputs[act_input].nick_add=cfg_getfloat(input_sect,"nick_add");
137
            inputs[act_input].roll_add=cfg_getfloat(input_sect,"roll_add");
138
            inputs[act_input].gier_add=cfg_getfloat(input_sect,"gier_add");
139
            inputs[act_input].gas_add=cfg_getfloat(input_sect,"gas_add");
140
 
141
 
142
            inputs[act_input].nick_up_btn=cfg_getint(input_sect,"nick_up_btn");
143
            inputs[act_input].nick_down_btn=cfg_getint(input_sect,"nick_down_btn");
144
 
145
            inputs[act_input].roll_left_btn=cfg_getint(input_sect,"roll_left_btn");        
146
            inputs[act_input].roll_right_btn=cfg_getint(input_sect,"roll_right_btn");
147
 
148
 
149
            inputs[act_input].rel_axis_nick=cfg_getint(input_sect,"rel_axis_nick");
150
            inputs[act_input].rel_axis_roll=cfg_getint(input_sect,"rel_axis_roll");
151
 
152
            inputs[act_input].rel_axis_gier=cfg_getint(input_sect,"rel_axis_gier");
153
            inputs[act_input].rel_axis_gas=cfg_getint(input_sect,"rel_axis_gas");
154
 
155
 
156
 
157
            act_input++;
158
          }
159
 
160
 
161
    }
162
 
163
  input_count=act_input;
164
  printf("%d inputs matching\n", input_count);
130 ligi 165
  return 0;
166
}
483 ligi 167
 
168