Perception Enabled Planning for Autonomous Systems