Add algorithm tests