Added distance matrix stuff to scheduler node and added sim_clock and wait_action

Added distance matrix stuff to scheduler node.

Copied over from strands_utils as they are mainly used by executive stuff.