Removed annoying debug messages
Fixed bug with "average task area" calculation
Some work on the RRT