[Constraint] Avoid explicit cast of sparse constraint to dense one. Add matrix methods with correct output