Change the foot inertial rate from 1ms to 5ms
TODO: read it from config file
update iCubGenova01 config file to add roght foot inertial sensor