implemented simple random reinitialization behavior if the new sensor position is not accepted
Merge pull request #39 from ipa-frm/feature/random_reinitialization

feature/random_reinitialization