Create 5619Drive.h

New drive library for 5619 specific motor configuration. 
Must check motor config for header file.  
This is used in the new teleop_wf.c