Math: Add clamp template function