Implemented Sugihara IKine