static struct dvobj_priv *sdio_dvobj_init(struct sdio_func *func)
{
int status = _FAIL;
struct dvobj_priv *dvobj = NULL;
PSDIO_DATA psdio;
_func_enter_;
if((dvobj = devobj_init()) == NULL) {
goto exit;
}
sdio_set_drvdata(func, dvobj);
psdio = &dvobj->intf_data;
psdio->func = func;
psdio->SdioRxFIFOCnt = 0;
if (sdio_init(dvobj) != _SUCCESS) {
RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("%s: initialize SDIO Failed!\n", __FUNCTION__));
goto free_dvobj;
}
rtw_reset_continual_io_error(dvobj);
status = _SUCCESS;
free_dvobj:
if (status != _SUCCESS && dvobj) {
sdio_set_drvdata(func, NULL);
devobj_deinit(dvobj);
dvobj = NULL;
}
exit:
_func_exit_;
return dvobj;
}
/**
* @brief Configure and enable the SDIO device.
*/
void sdio_begin(void)
{
sdio_gpios_init();
sdio_init();
sdio_power_on();
// Set initial SCK rate.
sdio_set_clock(400000);
delay_us(200); // generate 80 pulses at 400kHz
}
DSTATUS disk_initialize(BYTE pdrv)
{
if (pdrv >= _VOLUMES)
return STA_NOINIT;
// allocate descriptior
if (!devices[pdrv])
{
devices[pdrv] = malloc(sizeof(sdio_card_t));
if (!devices[pdrv])
return STA_NOINIT;
}
// Init card
if (sdio_init(devices[pdrv], f_drv_to_gpio(pdrv), _FF_HIGH_SPEED_SPI_FREQ_DIV) != SDIO_ERR_NONE)
return STA_NOINIT;
return 0;
}
int machine_init(void)
{
int i = 0;
rcc_clock_setup_hse_3v3(&rcc_hse_25mhz_3v3);
gpio_create(NULL, &gpio_led0);
gpio_create(NULL, &gpio_button);
/* UARTS */
for (i = 0; i < NUM_UARTS; i++) {
uart_create(&uart_configs[i]);
}
/* I2Cs */
for (i = 0; i < NUM_I2CS; i++) {
i2c_create(&i2c_configs[i]);
}
rng_create(1, RCC_RNG);
sdio_conf.rcc_reg = (uint32_t *)&RCC_APB2ENR;
sdio_conf.rcc_en = RCC_APB2ENR_SDMMC1EN;
sdio_init(&sdio_conf);
usb_init(&usb_guest);
ethernet_init(ð_config);
return 0;
}
void hw_init(void)
{
tz_init();
printk(BIOS_INFO, "trustzone initialized\n");
dmac_init();
printk(BIOS_INFO, "PL330 DMAC initialized\n");
lcd_init();
lcd_qos_init(15);
printk(BIOS_INFO, "LCD initialized\n");
v3d_init();
printk(BIOS_INFO, "V3D initialized\n");
audio_init();
printk(BIOS_INFO, "audio initialized\n");
neon_init();
printk(BIOS_INFO, "neon initialized\n");
pcie_init();
printk(BIOS_INFO, "PCIe initialized\n");
M0_init();
printk(BIOS_INFO, "M0 initialized\n");
ccu_init();
printk(BIOS_INFO, "CCU initialized\n");
sdio_init();
printk(BIOS_INFO, "SDIO initialized\n");
}
void myinit(void)
{
#pragma message "myinit()"
#pragma message "HAL_Init()"
#pragma message "SystemClock_Config()"
HAL_Init();
SystemClock_Config();
#ifdef ENABLE_GPIO
#pragma message "led_init()"
led_init();
#ifdef btn_init
#pragma message "btn_init()"
btn_init();
#endif
#endif
#ifdef ENABLE_RNG
#pragma message "rng_init()"
rng_init();
#endif
#ifdef ENABLE_UART
#pragma message "uart_init()"
uart_init();
#endif
#ifdef ENABLE_I2C
#pragma message "i2c_init()"
i2c_init();
#endif
#ifdef ENABLE_SPI
#pragma message "spi_init()"
spi_init();
#endif
#ifdef ENABLE_TIM
#pragma message "tim_init()"
tim_init();
#endif
#ifdef ENABLE_ADC
#pragma message "adc_init()"
adc_init();
#endif
#ifdef ENABLE_CAN
#pragma message "can_init()"
can_init();
#endif
#ifdef ENABLE_DAC
#pragma message "dac_init()"
dac_init();
#endif
#ifdef ENABLE_DMA
#pragma message "dma_init()"
dma_init();
#endif
#ifdef ENABLE_FLASH
#pragma message "flash_erase_img1()"
flash_erase_img1();
#endif
#ifdef ENABLE_ETH
#pragma message "eth_init()"
eth_init();
#endif
#ifdef ENABLE_DSP
#pragma message "dsp_init()"
dsp_init();
#endif
#ifdef ENABLE_USB
#pragma message "usb_init()"
usb_init();
#endif
#ifdef ENABLE_PCL
#pragma message "pcl_init()"
pcl_init();
#endif
#ifdef ENABLE_SDIO
#pragma message "sdio_init()"
sdio_init();
#endif
#ifdef ENABLE_DISPLAY
#pragma message "display_init()"
display_init();
#endif
#ifdef ENABLE_BR
#pragma message "br_init()"
br_init();
#endif
}
/*
* drv_init() - a device potentially for us
*
* notes: drv_init() is called when the bus driver has located a card for us to support.
* We accept the new device by returning 0.
*/
static int rtw_drv_init(
struct sdio_func *func,
const struct sdio_device_id *id)
{
struct net_device *pnetdev;
PADAPTER padapter;
struct dvobj_priv *pdvobjpriv;
PSDIO_DATA psdio;
RT_TRACE(_module_hci_intfs_c_, _drv_info_,
("+rtw_drv_init: vendor=0x%04x device=0x%04x class=0x%02x\n",
func->vendor, func->device, func->class));
//3 1. init network device data
pnetdev = rtw_init_netdev(NULL);
if (!pnetdev) goto error;
SET_NETDEV_DEV(pnetdev, &func->dev);
padapter = rtw_netdev_priv(pnetdev);
pdvobjpriv = &padapter->dvobjpriv;
pdvobjpriv->padapter = padapter;
psdio = &pdvobjpriv->intf_data;
psdio->func = func;
#ifdef CONFIG_IOCTL_CFG80211
rtw_wdev_alloc(padapter, &func->dev);
#endif
//3 2. set interface private data
sdio_set_drvdata(func, pdvobjpriv);
//3 3. init driver special setting, interface, OS and hardware relative
// set interface_type to sdio
padapter->interface_type = RTW_SDIO;
decide_chip_type_by_device_id(padapter, (u32)func->device);
//4 3.1 set hardware operation functions
padapter->HalData = rtw_zmalloc(sizeof(HAL_DATA_TYPE));
if (padapter->HalData == NULL) {
RT_TRACE(_module_hci_intfs_c_, _drv_err_,
("rtw_drv_init: can't alloc memory for HAL DATA\n"));
goto error;
}
padapter->hal_data_sz = sizeof(HAL_DATA_TYPE);
set_hal_ops(padapter);
//3 4. interface init
if (sdio_init(padapter) != _SUCCESS) {
RT_TRACE(_module_hci_intfs_c_, _drv_err_,
("rtw_drv_init: initialize device object priv Failed!\n"));
goto error;
}
padapter->intf_start = &sd_intf_start;
padapter->intf_stop = &sd_intf_stop;
//3 5. register I/O operations
if (rtw_init_io_priv(padapter) == _FAIL)
{
RT_TRACE(_module_hci_intfs_c_, _drv_err_,
("rtw_drv_init: Can't init io_priv\n"));
goto deinit;
}
//3 6.
intf_read_chip_version(padapter);
//3 7.
intf_chip_configure(padapter);
//3 8. read efuse/eeprom data
intf_read_chip_info(padapter);
//3 9. init driver common data
if (rtw_init_drv_sw(padapter) == _FAIL) {
RT_TRACE(_module_hci_intfs_c_, _drv_err_,
("rtw_drv_init: Initialize driver software resource Failed!\n"));
goto deinit;
}
//3 10. get WLan MAC address
// alloc dev name after read efuse.
rtw_init_netdev_name(pnetdev, ifname);
rtw_macaddr_cfg(padapter->eeprompriv.mac_addr);
_rtw_memcpy(pnetdev->dev_addr, padapter->eeprompriv.mac_addr, ETH_ALEN);
#ifdef CONFIG_PROC_DEBUG
#ifdef RTK_DMP_PLATFORM
rtw_proc_init_one(pnetdev);
#endif
#endif
#ifdef CONFIG_HOSTAPD_MLME
hostapd_mode_init(padapter);
#endif
#ifdef CONFIG_CONCURRENT_MODE
//set global variable to primary adapter
padapter->ph2c_fwcmd_mutex = &drvpriv.h2c_fwcmd_mutex;
padapter->psetch_mutex = &drvpriv.setch_mutex;
padapter->psetbw_mutex = &drvpriv.setbw_mutex;
padapter->hw_init_mutex = &drvpriv.hw_init_mutex;
#endif
#ifdef CONFIG_PLATFORM_RTD2880B
DBG_871X("wlan link up\n");
rtd2885_wlan_netlink_sendMsg("linkup", "8712");
#endif
#ifdef CONFIG_GLOBAL_UI_PID
if(ui_pid[1]!=0) {
DBG_871X("ui_pid[1]:%d\n",ui_pid[1]);
rtw_signal_process(ui_pid[1], SIGUSR2);
}
#endif
DBG_871X("bDriverStopped:%d, bSurpriseRemoved:%d, bup:%d, hw_init_completed:%d\n"
,padapter->bDriverStopped
,padapter->bSurpriseRemoved
,padapter->bup
,padapter->hw_init_completed
);
//3 8. Tell the network stack we exist
if (register_netdev(pnetdev) != 0) {
RT_TRACE(_module_hci_intfs_c_, _drv_err_,
("rtw_drv_init: register_netdev() failed\n"));
goto deinit;
}
#ifdef CONFIG_CONCURRENT_MODE
if(rtw_drv_if2_init(padapter)==_FAIL)
{
goto deinit;
}
#endif
RT_TRACE(_module_hci_intfs_c_, _drv_info_,
("-rtw_drv_init: Success. bDriverStopped=%d bSurpriseRemoved=%d\n",
padapter->bDriverStopped, padapter->bSurpriseRemoved));
return 0;
deinit:
sdio_deinit(padapter);
error:
if (padapter)
{
if (padapter->HalData && padapter->hal_data_sz>0) {
rtw_mfree(padapter->HalData, padapter->hal_data_sz);
padapter->HalData = NULL;
}
}
if (pnetdev)
rtw_free_netdev(pnetdev);
RT_TRACE(_module_hci_intfs_c_, _drv_crit_, ("-rtw_drv_init: FAIL!\n"));
return -1;
}
STATIC_PREFIX int fw_init_extl(unsigned por_cfg)
{
int rc=sdio_init(por_cfg);
return rc;
}
