Fix unit test
Added FAST implementation
Added unit test