As we switch to use Eigen vectors in other cases, shall we change the type of `joint_lb` and `joint_ub` to VectorXf for consistency?