TMSG44-CoolPi/Devices/max2870.c

#include "max2870.h"
#include "tmsgheaders.h"

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

void max2870_init(reg_addr_pci* pci_bar_1) {
	uint32_t cfg_reg = get_cfg_reg();

	// Set the command to enter the 32-bit mode
	SET_REGISTER_PARAM(cfg_reg, CFG_REG_WIDTH_SPI_TMSG_BITM, CFG_REG_WIDTH_SPI_TMSG_BITP, CFG_REG_WIDTH_SPI_TMSG_32_BIT);
	pci_bar_1->cfg_reg_addr = cfg_reg;
	
	//Init Header
	pci_bar_1->sbtmsg_addr = INIT_MAX2870_HEADER;
	//Init Data
	for (int k = 0; k < sizeof(max2870_regs) / 4; k++) {
		pci_bar_1->sbtmsg_addr = max2870_regs[k];
	}
	usleep(1);

	// Return to 24-bit mode
	SET_REGISTER_PARAM(cfg_reg, CFG_REG_WIDTH_SPI_TMSG_BITM, CFG_REG_WIDTH_SPI_TMSG_BITP, CFG_REG_WIDTH_SPI_TMSG_24_BIT);
	pci_bar_1->cfg_reg_addr = cfg_reg;
	usleep(1);

	set_cfg_reg(cfg_reg);
}