Added new function to check limit switches and stop motor if set.
Merge branch 'master' of https://github.com/phoenixfrc/Phoenix2014
Merge branch 'master' of https://github.com/phoenixfrc/Phoenix2014
Added limit switch to elevator test mode.