Add test and algorithms dir