Updated Teleop

using #defines instead of variables, decreased memory usage.