A Two-Stage Feature Point Detection and Marking Approach Based on the Labeled Multi-Bernoulli Filter