Subversion Repositories Projects

#include "config.h"


 
char *input_evdev_name;
char *input_joydev_name;

char *bluetooth_mac;
char *mk_tty;


char *evdev_path;

int  mk_socket_port=0;
int  loop_delay=0;

double nick_mul=0.3f;
double roll_mul=0.3f;
double gier_mul=0.3f;
double gas_mul=0.3f;


double nick_add=0.3f;
double roll_add=0.3f;
double gier_add=0.3f;
double gas_add=0.3f;

int rel_axis_nick;
int rel_axis_roll;
int rel_axis_gier;
int rel_axis_gas;

cfg_bool_t exit_after_init = cfg_false;


int input_count=0;

int parse_config(char* fname)
{


  static cfg_opt_t input_opts[] = {
    CFG_STR("name", 0, CFGF_NONE),    

    CFG_FLOAT("nick_mul", 1.0,CFGF_NONE),
    CFG_FLOAT("roll_mul", 1.0,CFGF_NONE),
    CFG_FLOAT("gier_mul", 1.0,CFGF_NONE),
    CFG_FLOAT("gas_mul", 1.0,CFGF_NONE),

    CFG_FLOAT("nick_add", 0,CFGF_NONE),
    CFG_FLOAT("roll_add", 0,CFGF_NONE),
    CFG_FLOAT("gier_add", 0,CFGF_NONE),
    CFG_FLOAT("gas_add", 0,CFGF_NONE),
   
    CFG_INT("rel_axis_nick",  -1,CFGF_NONE),
    CFG_INT("rel_axis_roll",  -1,CFGF_NONE),
    CFG_INT("rel_axis_gier",  -1,CFGF_NONE),
    CFG_INT("rel_axis_gas", -1,CFGF_NONE),

    CFG_INT("nick_up_btn",  -1,CFGF_NONE),
    CFG_INT("nick_down_btn",  -1,CFGF_NONE),
    CFG_INT("roll_left_btn",  -1,CFGF_NONE),
    CFG_INT("roll_right_btn", -1,CFGF_NONE),






    CFG_END()
  };

  cfg_opt_t opts[] = {
    CFG_SEC("input", input_opts, CFGF_MULTI | CFGF_TITLE),
    CFG_SIMPLE_STR("bluetooth_mac", &bluetooth_mac),    

    CFG_SIMPLE_STR("mk_tty", &mk_tty),    
    CFG_SIMPLE_STR("evdev_path", &evdev_path),    

    CFG_SIMPLE_BOOL("exit_after_init", &exit_after_init),
    CFG_SIMPLE_STR("input_evdev", &input_evdev_name),
    CFG_SIMPLE_STR("input_joydev", &input_joydev_name),
    CFG_SIMPLE_INT("loop_delay", &loop_delay),
    CFG_SIMPLE_INT("mk_socket_port", &mk_socket_port),
   
    CFG_SIMPLE_FLOAT("nick_mul", &nick_mul),
    CFG_SIMPLE_FLOAT("roll_mul", &roll_mul),
    CFG_SIMPLE_FLOAT("gier_mul", &gier_mul),
    CFG_SIMPLE_FLOAT("gas_mul", &gas_mul),

    CFG_SIMPLE_FLOAT("nick_add", &nick_add),
    CFG_SIMPLE_FLOAT("roll_add", &roll_add),
    CFG_SIMPLE_FLOAT("gier_add", &gier_add),
    CFG_SIMPLE_FLOAT("gas_add", &gas_add),
   
    CFG_SIMPLE_INT("rel_axis_nick", &rel_axis_nick),
    CFG_SIMPLE_INT("rel_axis_roll", &rel_axis_roll),
    CFG_SIMPLE_INT("rel_axis_gier", &rel_axis_gier),
    CFG_SIMPLE_INT("rel_axis_gas", &rel_axis_gas),
   
    CFG_END()
  };
 
  cfg_t *cfg;


  printf("Parsing config file %s\n",fname);
 
  cfg = cfg_init(opts, 0);

  cfg_parse(cfg,fname);


  input_count=cfg_size(cfg,"input");
 
  printf("%d inputs configured\n", input_count);
  int i;
  int act_input=0;
  for (i=0;i<input_count;i++)
    {
      cfg_t *input_sect=cfg_getnsec(cfg,"input",i);


      printf("processing input: %s\n",cfg_getstr( input_sect, "name"));
      int evdev_i=0;
     
      for (evdev_i=0;evdev_i<evdevs_count;evdev_i++)
        if (!strcmp(cfg_getstr( input_sect, "name"),evdevs[evdev_i].name))
          {
            sprintf( inputs[act_input].fname,"%s",evdevs[evdev_i].fname);
         
            // todo check lengt
            sprintf(inputs[act_input].name,"processing input: %s\n",cfg_getstr( input_sect, "name"));
           
            inputs[act_input].nick_mul=cfg_getfloat(input_sect,"nick_mul");
            inputs[act_input].roll_mul=cfg_getfloat(input_sect,"roll_mul");
            inputs[act_input].gier_mul=cfg_getfloat(input_sect,"gier_mul");
            inputs[act_input].gas_mul=cfg_getfloat(input_sect,"gas_mul");
           
            inputs[act_input].nick_add=cfg_getfloat(input_sect,"nick_add");
            inputs[act_input].roll_add=cfg_getfloat(input_sect,"roll_add");
            inputs[act_input].gier_add=cfg_getfloat(input_sect,"gier_add");
            inputs[act_input].gas_add=cfg_getfloat(input_sect,"gas_add");


            inputs[act_input].nick_up_btn=cfg_getint(input_sect,"nick_up_btn");
            inputs[act_input].nick_down_btn=cfg_getint(input_sect,"nick_down_btn");

            inputs[act_input].roll_left_btn=cfg_getint(input_sect,"roll_left_btn");        
            inputs[act_input].roll_right_btn=cfg_getint(input_sect,"roll_right_btn");


            inputs[act_input].rel_axis_nick=cfg_getint(input_sect,"rel_axis_nick");
            inputs[act_input].rel_axis_roll=cfg_getint(input_sect,"rel_axis_roll");

            inputs[act_input].rel_axis_gier=cfg_getint(input_sect,"rel_axis_gier");
            inputs[act_input].rel_axis_gas=cfg_getint(input_sect,"rel_axis_gas");



            act_input++;
          }


    }

  input_count=act_input;
  printf("%d inputs matching\n", input_count);
  return 0;
}