Updated configs/readme and...

made other stuff work.
Updated main teleop for swerve
"main" loop is basically up-to-date
WIP: Deleted unnecessary PID swerve stuff [1/2]
Small utility for resetting pods.