Add QuadPID library

untested