Add test for trajectory rectangular region constraint
Add test for trajectory rectangular region constraint