Cleaned up formatting of pose_follower_3d.cpp and .h
pose_follower_3d: first part of porting to MoveIt/groovy.