#include <8052.h>

// ===== Eingänge (Port 1) =====
__sbit __at (0x90) BTN_START;   // P1.0
__sbit __at (0x91) BTN_33;      // P1.1
__sbit __at (0x92) BTN_45;      // P1.2
__sbit __at (0x93) BTN_PITCH;   // P1.3

// ===== Ausgänge (Port 2) =====
__sbit __at (0xA2) MOTOR_PS;    // P2.2 Start/Stop (PS umbenannt)
__sbit __at (0xA3) SPD;         // P2.3 33/45
__sbit __at (0xA4) PITCH_EN;    // P2.4 Pitch Enable
__sbit __at (0xA5) RPM78;       // P2.5 78 RPM

// ===== Status (Port 3) =====
__sbit __at (0xB6) LD;          // P3.6 Lock Detect

// ===== LEDs (Port 0) =====
__sbit __at (0x80) LED_PITCH;   // P0.0
__sbit __at (0x81) LED_LOCK;    // P0.1
__sbit __at (0x82) LED45;       // P0.2
__sbit __at (0x83) LED33;       // P0.3

// ===== Variablen =====
unsigned char motor_on = 0;
unsigned char pitch_on = 0;
unsigned char speed_mode = 0; // 0=33,1=45,2=78

// ===== Funktionsprototypen =====
void delay_ms(unsigned int ms);
void update_leds(void);
void set_speed(void);
void soft_start(void);

// ===== Funktionen =====
void delay_ms(unsigned int ms) {
    unsigned int i,j;
    for(i=0;i<ms;i++)
        for(j=0;j<120;j++);
}

void update_leds(void) {
    LED33 = (speed_mode == 0) ? 0 : 1;
    LED45 = (speed_mode == 1) ? 0 : 1;
    LED_PITCH = pitch_on ? 0 : 1;
    LED_LOCK = (LD) ? 0 : 1;
}

void set_speed(void) {
    RPM78 = 0;
    if(speed_mode == 0) {
        SPD = 0;
    } else if(speed_mode == 1) {
        SPD = 1;
    } else {
        RPM78 = 1;
    }
}

void soft_start(void) {
    unsigned char i;
    MOTOR_PS = 1;  // sicher Stop
    delay_ms(100);
    for(i=0;i<5;i++) {
        MOTOR_PS = 0;
        delay_ms(50);
        MOTOR_PS = 1;
        delay_ms(50);
    }
    MOTOR_PS = 0;  // final Run
}

// ===== MAIN =====
void main(void) {
    // Default
    MOTOR_PS = 1;
    SPD = 0;
    RPM78 = 0;
    PITCH_EN = 0;

    while(1) {
        // ===== START / STOP =====
        if(BTN_START == 0) {
            delay_ms(50);
            if(BTN_START == 0) {
                motor_on = !motor_on;
                if(motor_on)
                    soft_start();
                else
                    MOTOR_PS = 1;
                while(BTN_START == 0);
            }
        }

        // ===== 33 RPM =====
        if(BTN_33 == 0) {
            delay_ms(50);
            if(BTN_33 == 0) {
                speed_mode = 0;
                set_speed();
                update_leds();
                while(BTN_33 == 0);
            }
        }

        // ===== 45 RPM =====
        if(BTN_45 == 0) {
            delay_ms(50);
            if(BTN_45 == 0) {
                speed_mode = 1;
                set_speed();
                update_leds();
                while(BTN_45 == 0);
            }
        }

        // ===== 78 RPM (beide gedrückt) =====
        if(BTN_33 == 0 && BTN_45 == 0) {
            delay_ms(50);
            if(BTN_33 == 0 && BTN_45 == 0) {
                speed_mode = 2;
                set_speed();
                update_leds();
            }
        }

        // ===== PITCH ON/OFF =====
        if(BTN_PITCH == 0) {
            delay_ms(50);
            if(BTN_PITCH == 0) {
                pitch_on = !pitch_on;
                PITCH_EN = pitch_on ? 1 : 0;
                update_leds();
                while(BTN_PITCH == 0);
            }
        }

        // LEDs aktualisieren (Lock Detect)
        update_leds();
    }
}