Completed change over to new format

- Fixed library links
- Fixed gyro sensor readouts by adding it to SENSORLIB
- Modified PID