TMSG44-CoolPi/Devices/max2870.c

#include "max2870.h"


const uint32_t max2870_regs[] ={
    0x80280000,
    0x800303E9,
    0x94005E42,
    0x00000133,
    0x638E80FC,
    0x01400005
};

void max2870_init(void *bar1) {

    // Set the command to enter the 32-bit mode
    uint32_t *ptr_cmd = bar1 + RST_ADDR;
    *ptr_cmd = CURR_WIDTH_32_BIT;
    //Init Header
    uint32_t *ptr = bar1 + MAX2870_BASE_ADDR;
    *ptr = InitMAX2870Header;
    //Init Data
    for (int k = 0; k < sizeof(max2870_regs)/4; k++) {
        uint32_t *ptr = bar1 + MAX2870_BASE_ADDR;
        *ptr = max2870_regs[k];
    }
    usleep(1);
    // Return to 24-bit mode
    uint32_t *ptr_cmd_2 = bar1 + RST_ADDR;
    *ptr_cmd_2 = CURR_WIDTH_24_BIT;

}