adds priority queue based on CFBinaryHeap; move fixed point vector math to separate header