Changed a few things to make sim work, added code to vision sim