Add benchmark code, reduce compile warnings

Add benchmark code, reduce compile warnings #55