RobotShoot and RobotMain

Made testable method to check encoder value