Doors - first test
Doors test fix and alg
New tests, alg fixes