IK markers now have r/l arm labels
Added rViz to RQT gui, updated speed selector and started safe arm trajs