-Started save to file
-Merged JWG branch
-Removed some redundant code
-First pass at file save
-Fixed file encoding issue
-Initialize the ConstantMap in SwerveDrive