Added generics & added solenoids, started robot drive