updating wam orientation + gravity