Clean up histogram code
Split up move and cmd topics
Update robosim to listen for cmd topics and publish move topics
Change move to cmd topic