Added Two Ball and a wait command

Also fixed minor errors.  TODO:  Restructure so all motors set in the
respected subsystem.  Need to clean up Valkyrie.java.