Nano Teensy CAN Enable

[stegallNAU]

Tested in bilateral hip system.
First motor initialized does not enable on first attempt.
Disable seems to work and is called before.
Does enable with second attempt.