changed joint pos to connect pid