Added discrete env
AStartPlanner added
Modified DiscreteEnvironment to support custom resolution for each dimensionw