Fixed IK for 1st link. Added IK function and world2screen (x,y)