Add support for standard ROS PoseStamped message

This message can be used for direct vehicle state estimation or control, for people who are using LSD_SLAM onboard quadrotors, ground robots, etc. You may fuse this with metric sensor data like IMU, baro, etc. to get scaled metric measurements.

Coordinate frame : Z out of camera , Y down, X right.