updated readme, more work on swerve program