Add Impulse, calculating mass for trajectory

Nevermind. I figured out the initial problem; Impulse / Mass. The rest was just flawed code, which I fixed.