implemented calcCOM(), made stubs for comJacobian and its test function