Calculation for Trajectory mass fixed a bit