Intake subsystem

[Ehimmell]

Found errors in main under wristcommand.java while basing a new branch from main, went ahead and fixed the class and cleaned it up under the intakeSubystem branch