Currently, sometimes the head rotation is in a reversed direction. Debug if it is caused by solve pnp or head rotation control code.