Update DatapointMap.java

Modified DatapointMap class to store StateDP and CommandDP instead of a generic Datapoint