Working algorithm. Track block and bring it back to green zone