Updated omni drive code to include actuators

Added elevator and claw code to omni drive.