Read data from DMP - Githubissues

Takaklas commented 5 years ago

Hello pimoroni team,

I would like to ask if there are any plans to enable DMP and read orientation data from this device, using this library, if possible! It will be for me the most amazing feature and a take-my-money move!

Thank you in advance.

Gadgetoid commented 5 years ago

I'm looking into it. Right now I'm struggling to find any clear instrutions for this specific chip detailing how to upload and use the DMP firmware and any DMP-related registers - bar the one that has the DMP_EN bit - are simply missing from the ICM 20948 datasheet. Looking at the eMD SmartMotion code reveals a lot of registers which fit into the gaps left in said datasheet, so I feel like I'm on the right path. Unfortunately the SmartMotion code is an enterprisey spaghetti mess that's not easy to decypher.

The setup process seems to involve flashing some 16Kb proprietary binary firmware blob over i2c, which is a fun start.

Takaklas commented 5 years ago

Really glad to hear this! Had a feeling it would be a total mess... Keep us updated please! Last resort is to import this library into RTIMULib. You know, just to diss tdk and its secretive tactics :P

BTW are there any instructions concerning the EOL mpu9250 DMP?

ghost commented 4 years ago

Just wanted to share what I have learned after contacting Invensense. The DMP is an FPGA that comes up brain dead and must be programmed with a proprietary binary image before it is useable. Examples can be found here but you must register then get permission to perform the downloads. I downloaded several and the one labeled "ICM-20948 v1.0 for Nucleo Board" seems to be the easiest to understand. But be warned, this is not easy. I decided for my project I'm just going to read the raw Accel/Gyro/Mag data and compute my own fusion with the algorithm here.

laughingrice commented 4 years ago

Initializing the DMP is relatively easy, this is the code I have (part of a bigger piece of code, so hopefully it's clear enough), let me know if you want more info (note that dmp_img is just a list created by copying the code previous mentioned, I think that if you google icm20948_img_dmp3a you can find a few copies people made without having to register and download all the Invensense code)

I'm still working on offloading the data from the DMP, but I'm pretty sure that this Arduino code should be adaptable easily enough along with the documentation, it's for the previous version MPU-9250 that should be mostly compatible, other than the DMP being 6 degrees of freedom rather than 9 degrees of freedom SparkFun_MPU-9250-DMP_Arduino_Library

    def InitDPM(self) -> None:
        '''
        Load the DPM firmware
        '''

        # Reset memories, enable DMP and FIFO
        self._acc.WriteReg(USER_CTRL, 0xFE)
        time.sleep(0.1)

        from .icm20948_img_dmp3a import dmp_img

        mem_bank = 0
        start_address = DMP_LOAD_START
        data_pos = 0

        # Write dpm firmware to memory
        while data_pos < len(dmp_img):
            write_len = min((256 - start_address, len(dmp_img[data_pos:])))
            self.WriteMems(mem_bank, start_address, dmp_img[data_pos:data_pos + write_len])

            data_pos += write_len
            mem_bank += 1
            start_address = 0

    def ValidateDPM(self) -> None:
        '''
        Validate the DPM firmware
        '''

        from .icm20948_img_dmp3a import dmp_img  # So that we know how much to read  

        read_img = [0] * len(dmp_img)

        mem_bank = 0
        start_address = DMP_LOAD_START
        data_pos = 0

        # Write dpm firmware to memory
        while data_pos < len(dmp_img):
            read_len = min((256 - start_address, len(dmp_img[data_pos:])))
            read_img[data_pos:data_pos + read_len] = self.ReadMems(mem_bank, start_address, read_len)

            data_pos += read_len
            mem_bank += 1
            start_address = 0

        diff = 0
        for z in zip(dmp_img, read_img):
            diff += abs(z[1] - z[0])

        return diff == 0

    def WriteMems(self, bank: int, address: int, data: list) -> None:
        '''
        Write data to device memory

        :param bank: Memory bank to write to
        :param address: memory address to write to
        :param data: list of byte values to write
        '''

        self.SelectBank(bank)

        # TODO: it might be possiple to write INV_MAX_SERIAL_WRITE bytes at a time
        for d in data:
            self._acc.WriteReg(MEM_START_ADDR, address)
            self._acc.WriteReg(MEM_R_W, d)
            address += 1`

Where _acc is the bus interface, that for a I2C connection is defined as:

try:
    import smbus

    class I2C_Bus:
        def __init__(self):
            '''
            Setup I2C
            '''

            self._acc = smbus.SMBus(I2C_PORT)

        def ReadReg(self, reg: int) -> int:
            '''
            Read register value

            :param reg: register to read

            :returns: register value
            '''

            # TODO: Looks like READ_FLAG is not needed for I2C
            return self._acc.read_byte_data(ICM20948_I2C_ADDRESS, reg)

        def ReadRegs(self, reg: int, cnt: int) -> list:
            '''
            Read consecutive cnt registers

            :param reg: First register to read
            :param cnt: number of register values to read

            :returns: list of register values
            '''

            return self._acc.read_i2c_block_data(ICM20948_I2C_ADDRESS, reg, cnt)

        def WriteReg(self, reg: int, data: int) -> None:
            '''
            Write registers value

            :param reg: register to write to
            :oaram data: data byte to write
            '''

            self._acc.write_byte_data(ICM20948_I2C_ADDRESS, reg, data)

        def WriteRegs(self, reg: int, data: list) -> None:
            '''
            Write consecutive cnt registers

            :param reg: First register to write to
            :oaram data: list of data byte to write
            '''

            self._acc.write_i2c_block_data(ICM20948_I2C_ADDRESS, reg, data)

except ImportError:
    print("Warning: smbus not installed")

laughingrice commented 4 years ago

I don't have the bandwidth right now to push all the way to a working DMP, but if someone is willing to help with the next step, I can put in some work to merge my DMP initialization code

polymurph commented 4 years ago

I am currently writing a driver for the ICM20948. I've gotten to the point where all 9DOFs are working. The only big problem still remaining is the internal DMP for sensor fusion. I can confirm that the Datasheet is a complete mess and contains some errors. It seems to me that TDK InvenSense does not want to provide any detailed descriptions about how to use the internal DMP. I would be glad if someone could share their knowledge and experience with this blackbox DMP.