Added few function translated from Matlab scripts
Fix a name issue