Added functions...
Implementation : Now always using ScalarType = double
Tests : Fixed tests