loading and unloading of shelfes implemented
cleanup, plan with two robots