Added an assert() to debug just in case fewer than 2 PathPoints should slip through somehow.
Added an assert() to debug just in case fewer than 2 PathPoints should slip through somehow.

opensim-org/opensim-core,opensim-org/opensim-core,opensim-org/opensim-core,opensim-org/opensim-core,opensim-org/opensim-core,opensim-org/opensim-core,opensim-org/opensim-core