after demo worked with matteo to get bug out. Seems to work. Some problems to fix are 1) The elevator approach points 2) comment out file printing 3) add an parameter for the goal 4)fix choosefloor to now get its observations from LogicalNaivgator noop