First attempt at an full multi_map / elevator solution. Will likley be buggy.
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
1)Fixed elevator approach points 2) Fixed comment out file printing 3)FIXED add an parameter for the goal 4)FIXED choosefloor to now get its observations from LogicalNaivgator noop. ---   all changes have not been completly tested
Problem: if goal to serve is not in a room we will have a call to getin which is a problem becase this command expects you to enter an area but decideing where to enter an area is ambigious. The fix is now clear but for now know not to add people in rooms that are not dooracc
Works going both up and down on the elevator.
ToDo:
1) See why load failed
2) See what is going on with false sensor readings and trying to go through the elevator door.
Tested load and re-added user prompt while changing floors. All tested and working.
Removed some useless commits
asp files added
merged with master
Merge remote-tracking branch 'yuqian/planrepair' into planrepair
merged with Jack
using ROS_DEBUG for prints instead of cerr
fixed a bug in which an action could be popped out of a plan list even if the list was empty. Still a segfault to fix