In regard to the garbage joint velocities, I found this in the reference manual:
“Since the area specified by the parameter is not initialized (0 clear) by this API, initialize the area by the application as necessary.”
So, I just need to clear the data before calling the API. I will fix this in the next commit.