Added init_constraint_03.m. Minor changes to speed up some tests.