quad_form function

Compute quadratic form