elevator_simulator.ini

SIGNAL void simulateCarMotor(void) {
  float currentPos;
  currentPos = 0.0;

  while (1) {
    if (TIM3_ARR > 0) {
      currentPos += ((float)TIM3_CCR1 / (float)TIM3_ARR) * 0.125;
      currentPos -= ((float)TIM3_CCR2 / (float)TIM3_ARR) * 0.125;
    }

    printf("%f\n", currentPos);
    
    // set the pulse sensor
    if (currentPos - (float)(int)currentPos < 0.25 ||
        currentPos - (float)(int)currentPos >= 0.75)
      PORTC |= 1 << 9;
    else
      PORTC &= ~(1 << 9);

    // set the floor sensor
    if (currentPos <= 0.5 ||
        currentPos >= 399.5 && currentPos <= 400.5 ||
        currentPos >= 799.5)
      PORTC |= 1 << 7;
    else
      PORTC &= ~(1 << 7);

    swatch(0.0025);
  }
}