|
@@ -23,7 +23,7 @@
|
|
/* Private typedef -----------------------------------------------------------*/
|
|
/* Private typedef -----------------------------------------------------------*/
|
|
/* Private define ------------------------------------------------------------*/
|
|
/* Private define ------------------------------------------------------------*/
|
|
#define PHOTO_LEVEL_ON (100)
|
|
#define PHOTO_LEVEL_ON (100)
|
|
-#define PHOTO_LEVEL_OFF (1000)
|
|
|
|
|
|
+#define PHOTO_LEVEL_OFF (800)
|
|
#define TIME_WAIT 1000
|
|
#define TIME_WAIT 1000
|
|
|
|
|
|
/* Private macro -------------------------------------------------------------*/
|
|
/* Private macro -------------------------------------------------------------*/
|
|
@@ -48,18 +48,15 @@ int main(void)
|
|
{
|
|
{
|
|
/* Initialize onBoard Hardware */
|
|
/* Initialize onBoard Hardware */
|
|
Board_Init();
|
|
Board_Init();
|
|
-
|
|
|
|
-#ifdef USE_SERVO_1
|
|
|
|
- Servo_1_CHNL = SERVO_CLOSE_VAL;
|
|
|
|
- delay_ms(100);
|
|
|
|
- Servo_1_CHNL = SERVO_INIT_VAL;
|
|
|
|
-#endif
|
|
|
|
-
|
|
|
|
-#ifdef USE_SERVO_2
|
|
|
|
- Servo_2_CHNL = SERVO_CLOSE_VAL;
|
|
|
|
|
|
+/*
|
|
|
|
+ Servo_CHNL = SERVO_OPEN1_VAL;
|
|
|
|
+ delay_ms(1000);
|
|
|
|
+ Servo_CHNL = SERVO_OPEN2_VAL;
|
|
|
|
+ delay_ms(1000);
|
|
|
|
+*/
|
|
|
|
+ Servo_CHNL = SERVO_CLOSE_VAL;
|
|
delay_ms(100);
|
|
delay_ms(100);
|
|
- Servo_2_CHNL = SERVO_INIT_VAL;
|
|
|
|
-#endif
|
|
|
|
|
|
+ Servo_CHNL = SERVO_INIT_VAL;
|
|
|
|
|
|
/* if light is on, wait for off */
|
|
/* if light is on, wait for off */
|
|
while (photo_Value <= PHOTO_LEVEL_OFF) {
|
|
while (photo_Value <= PHOTO_LEVEL_OFF) {
|
|
@@ -70,49 +67,45 @@ int main(void)
|
|
/* Infinite loop */
|
|
/* Infinite loop */
|
|
while (1)
|
|
while (1)
|
|
{
|
|
{
|
|
-#ifdef USE_SERVO_1
|
|
|
|
/* wait for light on */
|
|
/* wait for light on */
|
|
while (photo_Value > PHOTO_LEVEL_ON) {
|
|
while (photo_Value > PHOTO_LEVEL_ON) {
|
|
//IWDG->KR = 0xAAAA;
|
|
//IWDG->KR = 0xAAAA;
|
|
__WFI();
|
|
__WFI();
|
|
}
|
|
}
|
|
/* open servo 1 */
|
|
/* open servo 1 */
|
|
- Servo_1_CHNL = SERVO_OPEN_VAL;
|
|
|
|
|
|
+ Servo_CHNL = SERVO_OPEN1_VAL;
|
|
|
|
|
|
/* wait for light off */
|
|
/* wait for light off */
|
|
timeOut = TIME_WAIT;
|
|
timeOut = TIME_WAIT;
|
|
while (photo_Value <= PHOTO_LEVEL_OFF) {
|
|
while (photo_Value <= PHOTO_LEVEL_OFF) {
|
|
if (timeOut == 0) {
|
|
if (timeOut == 0) {
|
|
- Servo_1_CHNL = SERVO_INIT_VAL;
|
|
|
|
|
|
+ Servo_CHNL = SERVO_INIT_VAL;
|
|
}
|
|
}
|
|
__WFI();
|
|
__WFI();
|
|
}
|
|
}
|
|
/* close servo 1 */
|
|
/* close servo 1 */
|
|
- Servo_1_CHNL = SERVO_CLOSE_VAL;
|
|
|
|
|
|
+ Servo_CHNL = SERVO_CLOSE_VAL;
|
|
delay_ms(100);
|
|
delay_ms(100);
|
|
- Servo_1_CHNL = SERVO_INIT_VAL;
|
|
|
|
-#endif
|
|
|
|
-
|
|
|
|
-#ifdef USE_SERVO_2
|
|
|
|
|
|
+ Servo_CHNL = SERVO_INIT_VAL;
|
|
|
|
+
|
|
/* wait for light on */
|
|
/* wait for light on */
|
|
while (photo_Value > PHOTO_LEVEL_ON) {
|
|
while (photo_Value > PHOTO_LEVEL_ON) {
|
|
//IWDG->KR = 0xAAAA;
|
|
//IWDG->KR = 0xAAAA;
|
|
__WFI();
|
|
__WFI();
|
|
}
|
|
}
|
|
- Servo_2_CHNL = SERVO_OPEN_VAL;
|
|
|
|
|
|
+ Servo_CHNL = SERVO_OPEN2_VAL;
|
|
/* wait for light off */
|
|
/* wait for light off */
|
|
timeOut = TIME_WAIT;
|
|
timeOut = TIME_WAIT;
|
|
while (photo_Value <= PHOTO_LEVEL_OFF) {
|
|
while (photo_Value <= PHOTO_LEVEL_OFF) {
|
|
if (timeOut == 0) {
|
|
if (timeOut == 0) {
|
|
- Servo_2_CHNL = SERVO_INIT_VAL;
|
|
|
|
|
|
+ Servo_CHNL = SERVO_INIT_VAL;
|
|
}
|
|
}
|
|
__WFI();
|
|
__WFI();
|
|
}
|
|
}
|
|
/* close servo 1 */
|
|
/* close servo 1 */
|
|
- Servo_2_CHNL = SERVO_CLOSE_VAL;
|
|
|
|
|
|
+ Servo_CHNL = SERVO_CLOSE_VAL;
|
|
delay_ms(100);
|
|
delay_ms(100);
|
|
- Servo_2_CHNL = SERVO_INIT_VAL;
|
|
|
|
-#endif
|
|
|
|
|
|
+ Servo_CHNL = SERVO_INIT_VAL;
|
|
}
|
|
}
|
|
} /* End of mine() */
|
|
} /* End of mine() */
|
|
|
|
|