Refactored a bit.
The file now runs, it breaks somewhere.
fixed stuff
forward calibrated
Fixed integral + better settins
Adjusted the values for square and added new files for backwards and turning.
Added new files for sensor and added gitignore to ignore the backup files.