Add test for trajectory elliptical region constraint
Add test for trajectory elliptical region constraint