Reinstantiated the directional joint potential. Previous issues largely seemed to be a result of linearizing around the wrong point (q rather than q + dt qd). #define DIRECTIONAL_DEPENDENT_JOINT_POTENTIAL switches between the two.