small scene diff changes
trans rot to array pose bug fixed
draw axes for spec pt and added rigid3d warping option
new warping function cost and plotting for rigid3d