Added Cartesian path planning, experimental Cartesian control using a Jacobian pseudoinverse, and some general cleanup