TMSG44-CoolPi/Devices/lmk04821.c

#include "lmk04821.h"
#include "pci.h"

const uint32_t lmk04821regs_b[LMK_COUNT] = {
        0x000090,
        0x000010,
        0x000200,
        0x000306,
        0x0004D0,
        0x00055B,
        0x000600,
        0x000C51,
        0x000D04,
        0x010001,
        0x010197,
        0x010255,
        0x010302,
        0x010402,
        0x010500,
        0x0106F1,
        0x010790,
        0x010801,
        0x010955,
        0x010A55,
        0x010B02,
        0x010C02,
        0x010D00,
        0x010EB1,
        0x010F15,
        0x011001,
        0x011155,
        0x011255,
        0x011302,
        0x011402,
        0x011500,
        0x0116F1,
        0x011705,
        0x011801,
        0x011955,
        0x011A55,
        0x011B02,
        0x011C02,
        0x011D00,
        0x011EF1,
        0x011F05,
        0x012001,
        0x012155,
        0x012255,
        0x012302,
        0x012402,
        0x012500,
        0x0126F1,
        0x012715,
        0x012801,
        0x012955,
        0x012A55,
        0x012B02,
        0x012C02,
        0x012D00,
        0x012EF1,
        0x012F95,
        0x013001,
        0x013155,
        0x013255,
        0x013302,
        0x013402,
        0x013500,
        0x013671,
        0x013710,
        0x013840,
        0x013900,
        0x013A00,
        0x013B01,
        0x013C00,
        0x013D01,
        0x013E00,
        0x013F06,
        0x0140E3,
        0x014100,
        0x014200,
        0x014310,
        0x0144FF,
        0x01457F,
        0x014611,
        0x014713,
        0x014802,
        0x014942,
        0x014A02,
        0x014B16,
        0x014C00,
        0x014D00,
        0x014EC0,
        0x014F7F,
        0x015003,
        0x015102,
        0x015200,
        0x015300,
        0x015464,
        0x015500,
        0x015678,
        0x015700,
        0x01580A,
        0x015900,
        0x015A78,
        0x015BD4,
        0x015C20,
        0x015D00,
        0x015E00,
        0x015F0B,
        0x016000,
        0x016101,
        0x016224,
        0x016300,
        0x016400,
        0x016501,
        0x0171AA,
        0x017202,
        0x017300,
        0x017400,
        0x017C15,
        0x017D33,
        0x016600,
        0x016700,
        0x01680A,
        0x016959,
        0x016A20,
        0x016B00,
        0x016C00,
        0x016D20,
        0x016E13,
        0x1FFD00,
        0x1FFE00,
        0x1FFF53
};

const uint32_t lmk04821regs_a[LMK_COUNT] = {
        0x000090,
        0x000010,
        0x000200,
        0x000306,
        0x0004D0,
        0x00055B,
        0x000600,
        0x000C51,
        0x000D04,
        0x010001,
        0x010197,
        0x010255,
        0x010302,
        0x010402,
        0x010500,
        0x0106F1,
        0x010707,
        0x010801,
        0x010955,
        0x010A55,
        0x010B02,
        0x010C02,
        0x010D00,
        0x010EB1,
        0x010F07,
        0x011001,
        0x011155,
        0x011255,
        0x011302,
        0x011402,
        0x011500,
        0x0116F1,
        0x011707,
        0x011801,
        0x011955,
        0x011A55,
        0x011B02,
        0x011C02,
        0x011D00,
        0x011EF1,
        0x011F07,
        0x012001,
        0x012155,
        0x012255,
        0x012302,
        0x012402,
        0x012500,
        0x0126F1,
        0x012707,
        0x012801,
        0x012955,
        0x012A55,
        0x012B02,
        0x012C02,
        0x012D00,
        0x012EF1,
        0x012F0F,
        0x013001,
        0x013155,
        0x013255,
        0x013302,
        0x013402,
        0x013500,
        0x013679,
        0x013783,
        0x013840,
        0x013901,
        0x013A00,
        0x013B01,
        0x013C00,
        0x013D01,
        0x013E00,
        0x013F06,
        0x0140F2,
        0x014100,
        0x014200,
        0x014311,
        0x0144FF,
        0x01457F,
        0x014611,
        0x014713,
        0x014802,
        0x014942,
        0x014A02,
        0x014B16,
        0x014C00,
        0x014D00,
        0x014EC0,
        0x014F7F,
        0x015003,
        0x015102,
        0x015200,
        0x015300,
        0x015464,
        0x015500,
        0x015678,
        0x015700,
        0x01580A,
        0x015900,
        0x015A78,
        0x015BD4,
        0x015C20,
        0x015D00,
        0x015E00,
        0x015F0B,
        0x016000,
        0x016101,
        0x016224,
        0x016300,
        0x016400,
        0x016501,
        0x0171AA,
        0x017202,
        0x017360,
        0x017400,
        0x017C15,
        0x017D33,
        0x016600,
        0x016700,
        0x016801,
        0x016959,
        0x016A20,
        0x016B00,
        0x016C00,
        0x016D20,
        0x016E13,
        0x1FFD00,
        0x1FFE00,
        0x1FFF53
};
const uint32_t lmk04821_rst_a[] = {
        0x000090,
        0x000010
};
const uint32_t lmk04821_rst_b[] = {
        0x000090,
        0x000010
};

void lmk04821_a_init(reg_addr_pci* pce_bar_1) {
    //Rst for Lmk_a
    for (int i = 0; i < 2; i++) {
        pce_bar_1->lmk_a_addr = lmk04821_rst_a[i];
    }
    //Init for Lmk_a
    for (int j = 0; j < LMK_COUNT; j++) {
        pce_bar_1->lmk_a_addr = lmk04821regs_a[j];
    }
}

void lmk04821_b_init(void *bar1) {
    //Rst for Lmk_a
    for (int i = 0; i < 2; i++) {
        uint32_t *ptr = bar1 + LMK_B_BASE_ADDR;
        *ptr = lmk04821_rst_b[i];
    }
    //Init for Lmk_a
    for (int j = 0; j < LMK_COUNT; j++) {
        uint32_t *ptr = bar1 + LMK_B_BASE_ADDR;
        *ptr = lmk04821regs_b[j];
    }
}