/* PRV -----------------------------------------------------------------------*/ void prvHardwareInit() { c_common_i2c_init(); c_common_usart2_init(9600); c_io_sonar_init(); //c_io_rx24f_init(1000000); //c_rc_receiver_init(); LED = c_common_gpio_init(GPIOC, GPIO_Pin_13, GPIO_Mode_OUT); }
/** \brief Inicializacao componentes de IO. * * Incializa o hardware para comunicar com os sensores. Rotinas de teste * ainda precisam ser executadas. * @param None * @retval None */ void module_imu_init() { I2Cn=I2C1; /* Inicialização do hardware do módulo */ LED4 = c_common_gpio_init(GPIOD, GPIO_Pin_12, GPIO_Mode_OUT); //LED4 /* Inicialização da imu */ //c_common_i2c_init(I2Cn); c_io_imuAdafruit_init(I2Cn); //c_io_imu_config(ADAFRUIT); //imu_init(I2Cn); c_common_usart2_init(BAUDRATE); c_common_usart_puts(USARTn,"Adafruit 10DOF Tester"); c_common_usart_putchar(USARTn,'\n'); /* Initialise the sensors */ /* if(!c_io_lsm303_initAccel(I2Cn)) { // There was a problem detecting the ADXL345 ... check your connections c_common_usart_puts(USARTn,"Ooops, no LSM303 detected ... Check your wiring!"); c_common_usart_putchar(USARTn,'\n'); while(1); } if(!c_io_lsm303_initMag(I2Cn)) { // There was a problem detecting the LSM303 ... check your connections c_common_usart_puts(USARTn,"Ooops, no LSM303 detected ... Check your wiring!"); c_common_usart_putchar(USARTn,'\n'); while(1); } if(!c_io_bmp085_init(I2Cn,BMP085_MODE_ULTRAHIGHRES)) { // There was a problem detecting the BMP085 ... check your connections c_common_usart_puts(USARTn,"Ooops, no BMP085 detected ... Check your wiring or I2C ADDR!"); while(1); } if(!c_io_l3gd20_init(I2Cn,GYRO_RANGE_250DPS)) { // There was a problem detecting the L3GD20 ... check your connections c_common_usart_puts(USARTn,"Ooops, no L3GD20 detected ... Check your wiring or I2C ADDR!"); while(1); } */ /* Display some basic information on this sensor */ //displaySensorDetails(); }