refactor util
fix compilation
add ufk implementation for se3