Added a better P controller system, placeholders for limit switches, and some other things