6 axis movement

it’s still all wrong unfortunately, the yaw controll doesn’t work properly, it’s still set to world coordinents.