Fixed yaw and roll (previous commit had pitch working but yaw was causing roll and roll wasn't causing any rotation)