Ground Penetrating Radar-Assisted Multimodal Robot Odometry Using Subsurface Feature Matrix