Fixed homing so it no longer loops the wrong way

Need to go in and do math to make sure nothing else is wrong