Modified fastSLAM algorithm so orientation is based off the ship's compass reading.  Also added in oriention marker to simulation plots.  Now you can see which way the vehicle is facing.