ros control mostly working, tweaks needed