Minor fix to check right hand side

Declaring a vector without explicitly initializing the values to 0 seems
to (sometimes) have strange behavior. This has been fixed.

Some comments are added to explain buildOptimizationProblem.