Update OctocanumDrive.cpp

Wrote Toggle function