Fixed a homogeneous add problem in FK, arm is planar again :D