working version of robot pose
working nav example
super, super messy version of working nav example