Adding Foward Kinematics of Baxter