Added priorities to threads
Added FFT
Optimized vision processing
Finished code