1. In some drakeFunction.kinematic functions, add both q and kinsol in its eval function. Use kinsol when both inputs are given, use q to compute kinsol if only q is given.
2.Fix a documentation error in Concatenated
add a test for worldPosition