have fix speed controler needs prameter tuning and posebly error integration