organized mapping functions and added Pose functions