Added libraries path, added PID test, interrupt code and bugfixes