TestCases for Slope- and Distance Constraints

+ add SigmaPiConstraintTestCases.h / SigmaPiConstraintTestCases.h
+ add <unistd.h> in PoleBalancingVisualization.cpp for usleep (UNIX)