Added the correct pitch constraint equation.
Added the correct pitch constraint equation.

oliverlee/DynamicistToolKit,oliverlee/DynamicistToolKit,moorepants/DynamicistToolKit,moorepants/DynamicistToolKit