void InitSystem(void) { InitLed(); InitUart(); BluetoothInit(); InitAdc(); InitSensor(); InitFan(); InitRtc(); InitSecondTimer(); }
int main() { // Optical__value_all u8 Optical_value_all; // Optical__value_signal u8 Optical_value_signal; int Speed, Dir; float Ultrasonic_value_all[3]; int i; init_platform(); OptInit(); MotorInit(); BluetoothInit(); while (1) { Optical_value_all = OptGetAll(); printf("optical_all : %X \r\n", Optical_value_all); OptGetSingle(Opt1, &Optical_value_signal); printf("optical_CH1 : %X \r\n", Optical_value_signal); OptGetSingle(Opt2, &Optical_value_signal); printf("optical_CH2 : %X \r\n", Optical_value_signal); OptGetSingle(Opt3, &Optical_value_signal); printf("optical_CH3 : %X \r\n", Optical_value_signal); OptGetSingle(Opt4, &Optical_value_signal); printf("optical_CH4 : %X \r\n", Optical_value_signal); OptGetSingle(Opt5, &Optical_value_signal); printf("optical_CH5 : %X \r\n\r\n", Optical_value_signal); UltraGetAll(Ultrasonic_value_all); for (i = 0; i < 3; i++) { printf("u%d : %f mm\r\n", i, Ultrasonic_value_all[i]); usleep(1000); } printf("\r\n"); SetMotorSpeed(MotorL, 30); SetMotorSpeed(MotorR, -80); Speed = GetMotorSpeed(MotorL); printf("MotorL Speed : %d \r\n", Speed); Speed = GetMotorSpeed(MotorR); printf("MotorR Speed : %d \r\n", Speed); Dir = GetMotorDir(MotorL); printf("MotorL Dir : %d \r\n", Dir); Dir = GetMotorDir(MotorR); printf("MotorR Dir : %d \r\n\r\n", Dir); usleep(50 * 1000); BluetoothSend("Hello World\r\n",11); } cleanup_platform(); return 0; }