Moved acrobot traj opt test to test directory.
Added comments.
Fixes from Hongkai's comments.