Commit d0fcad21 authored by Oleg Dzhimiev's avatar Oleg Dzhimiev
Browse files

added auto-setting of OEM bit when working with OEM/RAD modules

parent b89b815a

py393/x393_sensor.py

+21 −6
Original line number Diff line number Diff line
@@ -2426,7 +2426,7 @@ input mem mtd4 ram1 


    def lepton35_i2c_w(self,num_sensor,reg,val):

        """

        write 16 bit value to an i2c register via sysfs

        Write 16 bit value to an i2c register via sysfs

        @param num_sensor - sensor port number (0..3)

        @param reg - register address (0x0 - power_on reg, 0x2 - status reg, 0x4 - command reg, 0x6 - data length reg, 0x08-0x26 - data regs)

        @param val - value
@@ -2439,7 +2439,7 @@ input mem mtd4 ram1 


    def lepton35_i2c_r(self,num_sensor,reg):

        """

        read 16 bit value from an i2c register via sysfs

        Read 16 bit value from an i2c register via sysfs

        @param num_sensor - sensor port number (0..3)

        @param reg - register address (0x0 - power_on reg, 0x2 - status reg, 0x4 - command reg, 0x6 - data length reg, 0x08-0x26 - data regs)

        """
@@ -2458,7 +2458,7 @@ input mem mtd4 ram1 


    def lepton35_poll_BUSY(self,num_sensor,ntries=10):

        """

        poll BUSY bit of a status reg

        Poll BUSY bit of a status reg

        @param num_sensor - sensor port number (0..3)

        @param ntries - timeout, exit after ntries times

        """
@@ -2480,12 +2480,18 @@ input mem mtd4 ram1 


    def lepton35_read(self,num_sensor,cmdreg,datalen):

        """

        Read attribute sequence

        Read attribute sequence, auto-sets OEM bit for OEM(0x08..) and RAD(0x0e..) modules

        @param num_sensor - sensor port number (0..3)

        @param cmdreg     - register base address

        @param datalen    - number of 16-bit words to read

        """

        res = []



        mod = (cmdreg>>8)&0xf

        # mode

        if mod==0x8 or mod==0xe:

            cmdreg += 0x4000



        busy = self.lepton35_poll_BUSY(num_sensor)

        if not busy:

            print("not busy, writing data length and command")
@@ -2504,12 +2510,17 @@ input mem mtd4 ram1 


    def lepton35_write(self,num_sensor,cmdreg,cmddata):

        """

        Write sequence

        Write sequence, auto-sets OEM bit for OEM(0x08..) and RAD(0x0e..) modules

        @param num_sensor - sensor port number (0..3)

        @param cmdreg     - register base address (true addr = cmdreg|0x1)

        @param cmddata    - string with comma separated values "0,1,2,3,4"

        """

        cmdreg = cmdreg|0x1

        mod = (cmdreg>>8)&0xf

        # mode

        if mod==0x8 or mod==0xe:

            cmdreg += 0x4000



        cmddata = [int(a) for a in cmddata.split(",")]

        datalen = len(cmddata)
@@ -2526,10 +2537,14 @@ input mem mtd4 ram1 


    def lepton35_run(self,num_sensor,cmdreg):

        """

        Run command sequence

        Run command sequence, auto-sets OEM bit for OEM(0x08..) and RAD(0x0e..) modules

        @param num_sensor - sensor port number (0..3)

        @param cmdreg     - register base address (true addr = cmdreg|0x2)

        """

        mod = (cmdreg>>8)&0xf

        # mode

        if mod==0x8 or mod==0xe:

            cmdreg += 0x4000

        busy = self.lepton35_poll_BUSY(num_sensor)

        if not busy:

            self.lepton35_i2c_w(num_sensor,self.LEPTON35_REG_CMD,cmdreg)