Disabled some things, unfortunately it is not working at the moment
Fixed algorithm, implemented simple goto(L,D) when idle
Cleaned up code, tested performance (All passed)

Backed up elevatoragent
Removed most uncommented code, except for where there was doubt about
later usage
Implement moving and idle predicated
merging
Idle checking is now robust and reassigning calls also works
Did the merging succeed?
Merge pull request #15 from tomrunia/fixing-algorithm

Fixing algorithm