Subversion Repositories Projects

Rev

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

Rev 140 Rev 483
1
#include "config.h"
1
#include "config.h"
-
 
2
 
2
 
3
 
3
 
4
 
4
char *input_evdev_name;
5
char *input_evdev_name;
5
char *input_joydev_name;
6
char *input_joydev_name;
6
 
7
 
7
char *bluetooth_mac;
8
char *bluetooth_mac;
-
 
9
char *mk_tty;
8
 
10
 
9
int  mk_socket_port=0;
11
int  mk_socket_port=0;
10
int  loop_delay=0;
12
int  loop_delay=0;
11
 
-
 
12
 
-
 
13
 
13
 
14
double nick_mul=0.3f;
14
double nick_mul=0.3f;
15
double roll_mul=0.3f;
15
double roll_mul=0.3f;
16
double gier_mul=0.3f;
16
double gier_mul=0.3f;
17
double gas_mul=0.3f;
17
double gas_mul=0.3f;
18
 
18
 
19
 
19
 
20
double nick_add=0.3f;
20
double nick_add=0.3f;
21
double roll_add=0.3f;
21
double roll_add=0.3f;
22
double gier_add=0.3f;
22
double gier_add=0.3f;
23
double gas_add=0.3f;
23
double gas_add=0.3f;
24
 
-
 
25
 
24
 
26
int rel_axis_nick=1;
25
int rel_axis_nick;
27
int rel_axis_roll=0;
26
int rel_axis_roll;
28
int rel_axis_gier=5;
27
int rel_axis_gier;
29
int rel_axis_gas=2;
-
 
30
 
28
int rel_axis_gas;
31
 
29
 
32
cfg_bool_t exit_after_init = cfg_false;
30
cfg_bool_t exit_after_init = cfg_false;
33
 
31
 
-
 
32
 
-
 
33
int input_count=0;
34
 
34
 
35
int parse_config(char* fname)
35
int parse_config(char* fname)
36
{
36
{
37
 
37
 
38
 
38
 
-
 
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
 
39
  cfg_opt_t opts[] = {
70
  cfg_opt_t opts[] = {
-
 
71
    CFG_SEC("input", input_opts, CFGF_MULTI | CFGF_TITLE),
-
 
72
    CFG_SIMPLE_STR("bluetooth_mac", &bluetooth_mac),    
40
   
73
 
41
    CFG_SIMPLE_STR("bluetooth_mac", &bluetooth_mac),    
74
    CFG_SIMPLE_STR("mk_tty", &mk_tty),    
42
 
75
 
43
    CFG_SIMPLE_BOOL("exit_after_init", &exit_after_init),
76
    CFG_SIMPLE_BOOL("exit_after_init", &exit_after_init),
44
    CFG_SIMPLE_STR("input_evdev", &input_evdev_name),
77
    CFG_SIMPLE_STR("input_evdev", &input_evdev_name),
45
    CFG_SIMPLE_STR("input_joydev", &input_joydev_name),
78
    CFG_SIMPLE_STR("input_joydev", &input_joydev_name),
46
    CFG_SIMPLE_INT("loop_delay", &loop_delay),
79
    CFG_SIMPLE_INT("loop_delay", &loop_delay),
47
    CFG_SIMPLE_INT("mk_socket_port", &mk_socket_port),
80
    CFG_SIMPLE_INT("mk_socket_port", &mk_socket_port),
48
   
81
   
49
    CFG_SIMPLE_FLOAT("nick_mul", &nick_mul),
82
    CFG_SIMPLE_FLOAT("nick_mul", &nick_mul),
50
    CFG_SIMPLE_FLOAT("roll_mul", &roll_mul),
83
    CFG_SIMPLE_FLOAT("roll_mul", &roll_mul),
51
    CFG_SIMPLE_FLOAT("gier_mul", &gier_mul),
84
    CFG_SIMPLE_FLOAT("gier_mul", &gier_mul),
52
    CFG_SIMPLE_FLOAT("gas_mul", &gas_mul),
85
    CFG_SIMPLE_FLOAT("gas_mul", &gas_mul),
53
 
86
 
54
    CFG_SIMPLE_FLOAT("nick_add", &nick_add),
87
    CFG_SIMPLE_FLOAT("nick_add", &nick_add),
55
    CFG_SIMPLE_FLOAT("roll_add", &roll_add),
88
    CFG_SIMPLE_FLOAT("roll_add", &roll_add),
56
    CFG_SIMPLE_FLOAT("gier_add", &gier_add),
89
    CFG_SIMPLE_FLOAT("gier_add", &gier_add),
57
    CFG_SIMPLE_FLOAT("gas_add", &gas_add),
90
    CFG_SIMPLE_FLOAT("gas_add", &gas_add),
58
   
91
   
59
    CFG_SIMPLE_INT("rel_axis_nick", &rel_axis_nick),
92
    CFG_SIMPLE_INT("rel_axis_nick", &rel_axis_nick),
60
    CFG_SIMPLE_INT("rel_axis_roll", &rel_axis_roll),
93
    CFG_SIMPLE_INT("rel_axis_roll", &rel_axis_roll),
61
    CFG_SIMPLE_INT("rel_axis_gier", &rel_axis_gier),
94
    CFG_SIMPLE_INT("rel_axis_gier", &rel_axis_gier),
62
    CFG_SIMPLE_INT("rel_axis_gas", &rel_axis_gas),
95
    CFG_SIMPLE_INT("rel_axis_gas", &rel_axis_gas),
63
 
-
 
64
 
-
 
65
 
-
 
66
   
96
   
67
    CFG_END()
97
    CFG_END()
68
  };
98
  };
69
 
99
 
70
  cfg_t *cfg;
100
  cfg_t *cfg;
71
 
101
 
72
 
102
 
73
  printf("Parsing config file %s\n",fname);
103
  printf("Parsing config file %s\n",fname);
74
 
104
 
75
  cfg = cfg_init(opts, 0);
105
  cfg = cfg_init(opts, 0);
76
 
106
 
77
  cfg_parse(cfg,fname);
107
  cfg_parse(cfg,fname);
78
 
108
 
-
 
109
 
-
 
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;
79
 
164
  printf("%d inputs matching\n", input_count);
80
  return 0;
165
  return 0;
-
 
166
}
-
 
167
 
81
}
168
 
82
 
169