Add script to convert frame_id of kinect of urdf

convert head_mount_kinect_ir_optical_frame_id -> openni_ir_optical_frame_id and 
head_mount_kinect_rgb_optical_frame_id -> openni_rgb_optical_frame_id.

In fact, we should use head_mount_kinect frame_id...