Modifications on ToolChange. Test simple client/server
Added fiducial num 4 and testing its detection results
Test version for simulation. Added calculated distance and orientation. Added moveIt motion.