Motor speed calculation