Subversion Repositories Projects

Rev

Rev 485 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

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