Fix build and add test and bench

Signed-off-by: Fabian Deutsch <fabian.deutsch@gmx.de>