How do I fix/re-organize this code? And how do I add collision detection to my specific code? [closed]