Minor bug fixes on simulator combined with adding project wanted_pos used to be set_wanted_position
Minor bug fixes on simulator combined with adding project wanted_pos used to be set_wanted_position