- unsigned speed = (rx_buf[1]-'0')*10+(rx_buf[2]-'0');
- IO::print("Set speed %d\n", speed);
- train->set_speed(speed);
+ // XXX The firmware is still coded for speed step based control
+ float speed = ((rx_buf[1]-'0')*10+(rx_buf[2]-'0'))*10/3.6*catalogue.get_scale();
+ IO::print("Set speed %g\n", speed);
+ train->set_control("speed", speed);