suservo: refactor y_mu_to_full_scale as portable

close #1032

artiq/coredevice/suservo.py

@@ -1,4 +1,4 @@
-from artiq.language.core import kernel, delay, now_mu, delay_mu
+from artiq.language.core import kernel, delay, now_mu, delay_mu, portable
 from artiq.language.units import us, ns
 from artiq.coredevice.rtio import rtio_output, rtio_input_data
 from artiq.coredevice import spi2 as spi
@@ -15,6 +15,21 @@ T_CYCLE = (2*(8 + 64) + 2 + 1)*8*ns
 COEFF_SHIFT = 11
 
 
+@portable
+def y_mu_to_full_scale(y):
+    """Convert Servo Y data from machine units to units of full scale."""
+    return y*(1./(1 << COEFF_WIDTH - 1))
+
+
+@portable
+def adc_mu_to_volts(x, gain):
+    """Convert Servo ADC data from machine units to Volt."""
+    val = (x >> 1) & 0xffff
+    mask = 1 << 15
+    val = -(val & mask) + (val & ~mask)
+    return sampler.adc_mu_to_volt(val, gain)
+
+
 class SUServo:
     """Sampler-Urukul Servo parent and configuration device.
 
@@ -206,11 +221,9 @@ class SUServo:
         :param adc: ADC channel number (0-7)
         :return: ADC voltage
         """
-        val = (self.get_adc_mu(channel) >> 1) & 0xffff
+        val = self.get_adc_mu(channel)
-        mask = 1 << 15
-        val = -(val & mask) + (val & ~mask)
         gain = (self.gains >> (channel*2)) & 0b11
-        return sampler.adc_mu_to_volt(val, gain)
+        return adc_mu_to_volts(val, gain)
 
 
 class Channel:
@@ -449,7 +462,7 @@ class Channel:
         :param profile: Profile number (0-31)
         :return: IIR filter output in Y0 units of full scale
         """
-        return self.get_y_mu(profile)*(1./(1 << COEFF_WIDTH - 1))
+        return y_mu_to_full_scale(self.get_y_mu(profile))
 
     @kernel
     def set_y_mu(self, profile, y):