Add method to get the starting differential pose of a path

Add method to get the starting differential pose of a path #396