Added coordinate transforms (body <--> inertial)