void ADIS16448_Init(void)
{
GPIO_InitTypeDef GPIO_InitStructure;
RCC_APB2PeriphClockCmd( RCC_APB2Periph_GPIOB, ENABLE );
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_12;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
GPIO_Init(GPIOB, &GPIO_InitStructure);
GPIO_SetBits(GPIOB,GPIO_Pin_12);
SPI2_Init();
MPU6500_spi_init();
}
void SPI2_Init(void)
{
GPIO_InitTypeDef GPIO_InitStructure;
SPI_InitTypeDef SPI_InitStructure;
RCC_APB2PeriphClockCmd( RCC_APB2Periph_GPIOB, ENABLE );
RCC_APB1PeriphClockCmd( RCC_APB1Periph_SPI2, ENABLE );
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_13 | GPIO_Pin_14 | GPIO_Pin_15;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
GPIO_Init(GPIOB, &GPIO_InitStructure);
GPIO_SetBits(GPIOB,GPIO_Pin_13 | GPIO_Pin_14 | GPIO_Pin_15);
SPI_I2S_DeInit(SPI2);
SPI_InitStructure.SPI_Direction = SPI_Direction_2Lines_FullDuplex;
SPI_InitStructure.SPI_Mode = SPI_Mode_Master;
SPI_InitStructure.SPI_DataSize = SPI_DataSize_16b;
SPI_InitStructure.SPI_CPOL = SPI_CPOL_High;
SPI_InitStructure.SPI_CPHA = SPI_CPHA_2Edge;
SPI_InitStructure.SPI_NSS = SPI_NSS_Soft;
SPI_InitStructure.SPI_BaudRatePrescaler = SPI_BaudRatePrescaler_128;
SPI_InitStructure.SPI_FirstBit = SPI_FirstBit_MSB;
SPI_InitStructure.SPI_CRCPolynomial = 7;
SPI_Init(SPI2, &SPI_InitStructure);
SPI_Cmd(SPI2, ENABLE);
SPI_I2S_ClearITPendingBit(SPI2, SPI_I2S_IT_RXNE);
}
u8 ADIS16448_Read(void)
{
while(1)
{
delay_us(20);
CS = 0;
SPI2_ReadWriteByte(0x5600);
delay_us(10);
res = SPI2_ReadWriteByte(0);
CS = 1;
delay_us(20);
CS = 0;
SPI2_ReadWriteByte(0x3800);
delay_us(10);
tmp = SPI2_ReadWriteByte(0);
CS = 1;
delay_us(20);
CS = 0; delay_us(10);
SPI2_ReadWriteByte(0x0A00);
delay_us(10);
gyr_x = SPI2_ReadWriteByte(0);
delay_us(10);
CS = 1;
delay_us(20);
CS = 0;
delay_us(10);
SPI2_ReadWriteByte(0x0C00);
delay_us(10);
gyr_y = SPI2_ReadWriteByte(0);
delay_us(10);
CS = 1;
delay_us(20);
CS = 0; delay_us(10);
SPI2_ReadWriteByte(0x0E00);
delay_us(10);
gyr_z = SPI2_ReadWriteByte(0);
delay_us(10);
CS = 1;
}
delay_us(20);
CS = 0;
tmp = SPI2_ReadWriteByte(0x3E00);
for(i=0;i<12;i++){
arr[i] = SPI2_ReadWriteByte(0);
}
CS = 1;
return res;
}
SPI_FLASH_CS_LOW();
delay(100000);
gyr_x = SPI2_ReadWriteByte(0x0A00);
delay(100000);
SPI_FLASH_CS_HIGH();
delay(100000);
SPI_FLASH_CS_LOW();
delay(100000);
gyr_y = SPI2_ReadWriteByte(0x0C00);
delay(100000);
SPI_FLASH_CS_HIGH();
delay(100000);
SPI_FLASH_CS_LOW();
delay(100000);
gyr_z = SPI2_ReadWriteByte(0x0E00);
delay(100000);
SPI_FLASH_CS_HIGH();
delay(100000);
#if 0
SPI_FLASH_CS_LOW();
SPI2_ReadWriteByte(0x3E00);
for(i=0;i<12;i++){delay(100000);
arr[i] = SPI2_ReadWriteByte(0xff);
}
SPI_FLASH_CS_HIGH();
#endif
while (SPI_I2S_GetFlagStatus(SPI2, SPI_I2S_FLAG_RXNE) == RESET)
{
retry++;
delay(100);//适当延时!!
if(retry>200)
return 0;
}