Check that length of input path is not 0 in path optimizer.
Use standard deviation stored as an attribute.
Implement a simple direct path validator.

  The validator samples the direct path with a step of 2*penetration and check
  sample configuration along the direct path.