Add spacenav2pose

Add script to publish PoseStamped by using spacenav