Added spatial regularization, complete implementation but only 8 FPS