Added test function (no xtion required)