Reorganized folder
Reorganized a bit and added some matlab FP code