Pose2d fixed! It seems to work fairly reliably in rviz, but more error testing is needed
Launch changes
Remove extra files
Launch/safety controller tweaks
Start writing README.md