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;
}
