Switch only works for closed doors. Nice improvemente in iterations.
6/7 not working
Merge pull request #8 from diogom8/RafaBranch

Rafa branch