Set new mode immediately in HMC5843::setMode and HMC5883L::setMode

It seems like setMode should set the new operating mod immediately