Implemented fine-grained integration to find desired position, velocity, acceleration for cartesian control.