WebSVN - BL-Ctrl - Diff - Rev 50 and 51

 #include "main.h"
 unsigned int  PWM = 0;
 unsigned int  Strom = 0; //ca. in 0,1A
 unsigned char Strom_max = 0;
 unsigned char Mittelstrom = 0;
 unsigned int  Drehzahl = 0;  // in 100UPM  60 = 6000
 unsigned int  KommutierDelay = 10;
 unsigned int  I2C_Timeout = 0;
 unsigned int SIO_Timeout = 0;
    Delay_ms(300);
+  }
    Delay_ms(1000);
+}
-#define TEST_STROMGRENZE 100
+#define TEST_STROMGRENZE 90
 unsigned char DelayM(unsigned int timer)
+{
  while(timer--)
+  {
    FastADConvert();
    if(Strom > TEST_STROMGRENZE)
        {
-        STEUER_OFF;
+        FETS_OFF;
         return(1);
+       }
+  }
  return(0);
+}
 unsigned char Delay(unsigned int timer)
+{
+ while(timer--)
  while(timer--)
 //   if(SENSE_H) { PORTC |= ROT; } else { PORTC &= ~ROT;}
+  }
+ return(0);
+}
+void ShowSense(void)
+{
+ if(SENSE_H) { PORTC |= ROT; } else { PORTC &= ~ROT;}
+}
+#define HIGH_A_EIN PORTB |= 0x08
+#define HIGH_B_EIN PORTB |= 0x04
+#define HIGH_C_EIN PORTB |= 0x02
- return(0);
+#define LOW_A_EIN  PORTD |= 0x08
 #define LOW_B_EIN  PORTD |= 0x10
 #define LOW_C_EIN  PORTD |= 0x20
 void MotorTon(void)
-void MotorTon(void)
+//############################################################################
 //############################################################################
+    unsigned char ADR_TAB[5] = {0,0,2,1,3};
+    unsigned int timer = 300,i;
+    unsigned int t = 0;
     unsigned char MosfetKurzschluss = 0, MosfetOkay = 0,anz = 0;
     unsigned int timer = 300,i;
-    unsigned int t;
-    unsigned char MosfetKurzschluss = 0, MosfetOkay = 0,anz = 0;
-    DISABLE_SENSE_INT;
-    cli();//Globale Interrupts Ausschalten
+    PORTC &= ~ROT;
-    PORTC &= ~ROT;
+    Delay_ms(300 * ADR_TAB[MotorAdresse]);
-    PWM = 0;
-    SetPWM();
-    uart_putchar('\n');
+    DISABLE_SENSE_INT;
-    STEUER_OFF;
+    cli();//Globale Interrupts Ausschalten
-//#define  STEUER_A_L {PORTD &= ~0x30; PORTD |= 0x08;}
+    uart_putchar('\n');
-//#define  STEUER_B_L {PORTD &= ~0x28; PORTD |= 0x10;}
+    STEUER_OFF;
 //#define  STEUER_C_L {PORTD &= ~0x18; PORTD |= 0x20;}
 //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
-//+ High-Mosfets auf Kurzschluss testen
-//+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
+//+ High-Mosfets auf Kurzschluss testen
-    Strom = 0;
+//+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
-    PORTD |= 0x08; // Low  A ein
+    Strom = 0;
-    PORTB |= 0x04; // High B ein; und A gegen B
-//PORTB |= 0x08; // Test A
+    LOW_B_EIN;
-    if(DelayM(3))
+    HIGH_A_EIN;
     if(DelayM(3))
-        MosfetKurzschluss = 0x01;
+       {
         anz = 1;
-        uart_putchar('A');
+        uart_putchar('1');
        }
-    STEUER_OFF;
+    FETS_OFF;
-    DelayM(100);
-    Strom = 0;
+    Delay(1000);
-    PORTD |= 0x10; // Low B ein
+    Strom = 0;
-    PORTB |= 0x02; // High C ein
+    LOW_A_EIN;
-//PORTB |= 0x04; // Test B
-    if(DelayM(3))
+    HIGH_B_EIN;
     if(DelayM(3))
-        anz = 2;
+       {
-        MosfetKurzschluss = 0x02;
+        anz = 2;
-        uart_putchar('B');
+        uart_putchar('2');
        }
-    STEUER_OFF;
+    FETS_OFF;
-    DelayM(100);
-    Strom = 0;
-    PORTD |= 0x20; // Low C ein
+    Delay(1000);
-    PORTB |= 0x04; // High B ein
+    Strom = 0;
-    //PORTB |= 0x0C; // High A+B ein
+    LOW_B_EIN; // Low C ein
-//PORTB |= 0x02; // Test C
-    if(DelayM(3))
+    HIGH_C_EIN; // High B ein
     if(DelayM(3))
-        anz = 3;
+       {
-        MosfetKurzschluss = 0x04;
+        anz = 3;
-        uart_putchar('C');
+        uart_putchar('3');
        }
-    STEUER_OFF;
-    DelayM(100);
+    FETS_OFF;
-    PORTD |= 0x08; // Low  A ein; und A gegen C
+    Delay(1000);
-    PORTB |= 0x02; // High C ein
+    LOW_A_EIN; // Low  A ein; und A gegen C
-//PORTB |= 0x08; // Test A
+    HIGH_C_EIN; // High C ein
     if(DelayM(3))
+       {
         anz = 3;
         MosfetKurzschluss = 0x01;
-        uart_putchar('C');
+        uart_putchar('7');
+       }
     FETS_OFF;
-    STEUER_OFF;
+    DelayM(10000);
-    DelayM(100);
+if(anz) while(1) RotBlink(anz);  // bei Kurzschluss nicht starten
- if(anz) while(1) RotBlink(anz);
+//+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
-//+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
+//+ LOW-Mosfets auf Schalten und Kurzschluss testen
+//+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
-//+ Low-Mosfets auf Kurzschluss testen
+ if(UDR == ' ') {t = 65535; uart_putchar('_');} else t = 1000; // Ausführlicher Test
-//+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
+ Strom = 0;
-    Strom = 0;
+ for(i=0;i<t;i++)
-    PORTB |= 0x08; // Test A
+ {
+  LOW_A_EIN;
-//PORTD |= 0x08; // Low A ein
+  DelayM(1);
+  FETS_OFF;
-    if(DelayM(3))
+  Delay(5);
-       {
+  HIGH_A_EIN;
+  DelayM(1);
-        anz = 4;
+  FETS_OFF;
+  if(Strom > 40) {anz = 4; uart_putchar('4'); break;}
-        MosfetKurzschluss = 0x01;
+  Delay(5);
-        uart_putchar('a');
+ }
+ Delay(10000);
-       }
-    STEUER_OFF;
+ Strom = 0;
-    Strom = 0;
+ for(i=0;i<t;i++)
-    PORTB |= 0x04; // Test B
+ {
-//PORTD |= 0x10; // Low B ein
+  LOW_B_EIN;
-    if(DelayM(3))
+  DelayM(1);
-       {
+  FETS_OFF;
+  Delay(5);
-        anz = 5;
+  HIGH_B_EIN;
+  DelayM(1);
+  FETS_OFF;
-        MosfetKurzschluss = 0x02;
+  if(Strom > 40) {anz = 5; uart_putchar('5'); break;}
-        uart_putchar('b');
+  Delay(5);
+ }
-       }
+ Strom = 0;
+ Delay(10000);
-    STEUER_OFF;
-    Strom = 0;
+ for(i=0;i<t;i++)
-    PORTB |= 0x02; // Test C
+ {
-//PORTD |= 0x20; // Low C ein
+  LOW_C_EIN;
-    if(DelayM(3))
+  DelayM(1);
-       {
+  FETS_OFF;
+  Delay(5);
-        anz = 6;
+  HIGH_C_EIN;
-        MosfetKurzschluss = 0x04;
+  DelayM(1);
-        uart_putchar('c');
   FETS_OFF;
-    STEUER_OFF;
+  if(Strom > 40) {anz = 6; uart_putchar('6'); break;}
   Delay(5);
  if(anz) while(1) RotBlink(anz);
 //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 //+ High-Mosfets auf Schalten testen
 //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
     SENSE_A;
-    STEUER_OFF;
+    FETS_OFF;
+    LOW_B_EIN; // Low B ein
-    PORTD |= 0x10; // Low B ein
+    LOW_C_EIN; // Low C ein
+    Strom = 0;
+#define TONDAUER  40000
-    PORTD |= 0x20; // Low C ein
+#define SOUND_E 2
-    Strom = 0;
+#define SOUND1_A 300
-#define TONDAUER  100000
+#define SOUND2_A 330
-#define SOUND_E 5
+#define SOUND3_A 360
-#define SOUND2_A 500
     for(i=0; i< (TONDAUER / SOUND2_A) ; i++)
      {
-      PORTB |= 0x08; // Test A
+      HIGH_A_EIN; // Test A
       Delay(SOUND_E);
-      if(SENSE_L) { MosfetOkay |= 0x01; } else { MosfetOkay &= ~0x01;}
+      if(MessAD(0) > 50) { MosfetOkay |= 0x01; } else { MosfetOkay &= ~0x01;};
       PORTB = 0;
-      Delay(SOUND2_A);
+      Delay(SOUND1_A);
-     }
     STEUER_OFF;
-    SENSE_B;
+    FETS_OFF;
-    PORTD |= 0x08; // Low A ein
-    PORTD |= 0x20; // Low C ein
+    LOW_A_EIN; // Low A ein
-#define SOUND1_A 600
+    LOW_C_EIN; // Low C ein
     for(i=0; i<(TONDAUER / SOUND1_A); i++)
+     {
-      PORTB |= 0x04; // Test B
+      HIGH_B_EIN; // Test B
       Delay(SOUND_E);
-      if(SENSE_L) { MosfetOkay |= 0x02; } else { MosfetOkay &= ~0x02;}
-      PORTB = 0;
+      if(MessAD(1) > 50) { MosfetOkay |= 0x02; } else { MosfetOkay &= ~0x02;};
-      Delay(SOUND1_A);
+      PORTB = 0;
-     }
       Delay(SOUND1_A);
     STEUER_OFF;
-    SENSE_C;
-    PORTD |= 0x08; // Low A ein
+    FETS_OFF;
-    PORTD |= 0x10; // Low B ein
+    LOW_A_EIN; // Low A ein
-#define SOUND3_A  700
+    LOW_B_EIN; // Low B ein
     for(i=0; i<(TONDAUER / SOUND3_A); i++)
+     {
-      PORTB |= 0x02; // Test C
+      HIGH_C_EIN; // Test C
       Delay(SOUND_E);
-      if(SENSE_L) { MosfetOkay |= 0x04; } else { MosfetOkay &= ~0x04;}
+      if(MessAD(2) > 50) { MosfetOkay |= 0x04; } else { MosfetOkay &= ~0x04;};
       PORTB = 0;
-      Delay(SOUND3_A);
+      Delay(SOUND2_A);
      }
-    STEUER_OFF;
+    FETS_OFF;
 //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 //+ Low-Mosfets auf Schalten testen
 //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
     SENSE_B;
-    PORTD |= 0x08; // Low A ein
+    LOW_A_EIN; // Low A ein
 #define SOUND2_A 500
     for(i=0; i< (TONDAUER / SOUND2_A) ; i++)
+     {
-      PORTB |= 0x04; // Test B
+      HIGH_B_EIN; // Test B
       Delay(SOUND_E);
-      if(SENSE_L) { MosfetOkay |= 0x08; } else { MosfetOkay &= ~0x08;}
-      PORTB = 0;
+      if(MessAD(0) > 50) { MosfetOkay &= ~0x08;} else { MosfetOkay |= 0x08;};
-      Delay(SOUND2_A);
+      PORTB = 0;
       Delay(SOUND2_A);
+     }
     STEUER_OFF;
-    SENSE_C;
+//++++++++++++++++++++++++++++++++++++
-    PORTD |= 0x10; // Low B ein
+    LOW_C_EIN; // Low C ein
-    for(i=0; i<(TONDAUER / SOUND3_A); i++)
+    for(i=0; i<(TONDAUER / SOUND1_A); i++)
+     {
-      PORTB |= 0x02; // Test C
-      Delay(SOUND_E);
+      HIGH_B_EIN; // Test B
+      Delay(SOUND_E);
-      if(SENSE_L) { MosfetOkay |= 0x10; } else { MosfetOkay &= ~0x10;}
+      if(MessAD(2) > 50) { MosfetOkay &= ~0x20;} else { MosfetOkay |= 0x20;};
       PORTB = 0;
       Delay(SOUND3_A);
+     }
+    FETS_OFF;
-    STEUER_OFF;
+//++++++++++++++++++++++++++++++++++++
-    SENSE_B;
+    FETS_OFF;
-    PORTD |= 0x20; // Low C ein
+    LOW_B_EIN; // Low B ein
-    for(i=0; i<(TONDAUER / SOUND1_A); i++)
+    for(i=0; i<(TONDAUER / SOUND3_A); i++)
+     {
+      HIGH_C_EIN; // Test C
+      Delay(SOUND_E);
+      if(MessAD(1) > 50) { MosfetOkay &= ~0x10;} else { MosfetOkay |= 0x10;};
-      PORTB |= 0x04; // Test B
+      PORTB = 0;
-      Delay(SOUND_E);
+      Delay(SOUND3_A);
-      if(SENSE_L) { MosfetOkay |= 0x20; } else { MosfetOkay &= ~0x20;}
+     }
-      PORTB = 0;
+    FETS_OFF;
-      Delay(SOUND1_A);
+//++++++++++++++++++++++++++++++++++++
 //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
     sei();//Globale Interrupts Einschalten
+//    Delay_ms(250 * MotorAdresse);
+/*
-    Delay_ms(250 * MotorAdresse);
+    LOW_A_EIN; // Low B ein
 #define SOUND8_A 650
-#define SOUND8_E 7
+    for(i=0; i<(TONDAUER / SOUND8_A); i++)
 #define SOUND8_A 650
-    for(i=0; i<(TONDAUER / SOUND8_A); i++)
+      HIGH_B_EIN; // Test B
       Delay(SOUND_E);
-      for(timer = 0; timer < SOUND8_E; timer++) PORTB |= 0x04; // Test B
+      PORTB = 0;
-      for(timer = 0; timer < SOUND8_A; timer++) PORTB = 0;
+      Delay(SOUND8_A);
+     }
+*/
  if(!(MosfetOkay & 0x01))  { anz = 1; uart_putchar('A'); } else
- if(!(MosfetOkay & 0x02))  { anz = 2; uart_putchar('B'); } else
- if(!(MosfetOkay & 0x04))  { anz = 3; uart_putchar('C'); } else
- if(!(MosfetOkay & 0x08))  { anz = 4; uart_putchar('a'); } else
- if(!(MosfetOkay & 0x10))  { anz = 5; uart_putchar('b'); } else
- if(!(MosfetOkay & 0x20))  { anz = 6; uart_putchar('c'); }
+ if(!(MosfetOkay & 0x02))  { anz = 2; uart_putchar('B'); } else
- Delay_ms(250 * (4-MotorAdresse));
- if(MosfetOkay != 0x3f) Delay_ms(1000);
-#define TONDAUER  80000
-#define SOUND9_E 20
-#define SOUND9_A 500
- while(anz--)
-  {
-   PORTC |= ROT;
-    if(!(MosfetOkay & 0x04) || !(MosfetOkay & 0x20))  // Schalter C defekt
-     {
-     PORTD |= 0x10; // Low B ein
-     for(i=0; i< (TONDAUER / SOUND9_A) ; i++)
-      {
-       for(timer = 0; timer < SOUND9_E; timer++) PORTB |= 0x08; // Test A
-       for(timer = 0; timer < SOUND9_A; timer++) PORTB = 0;
-      }
-     }
-    else
-    if(!(MosfetOkay & 0x02) || !(MosfetOkay & 0x10)) // Schalter B defekt
-     {
-     PORTD |= 0x20; // Low C ein
-     for(i=0; i< (TONDAUER / SOUND9_A) ; i++)
-      {
-       for(timer = 0; timer < SOUND9_E; timer++) PORTB |= 0x08; // Test A
-       for(timer = 0; timer < SOUND9_A; timer++) PORTB = 0;
-      }
-     }
-    else
-    if(!(MosfetOkay & 0x01) || !(MosfetOkay & 0x08)) // Schalter A defekt
-     {
+ if(!(MosfetOkay & 0x04))  { anz = 3; uart_putchar('C'); } else
-     PORTD |= 0x20; // Low C ein
-     for(i=0; i< (TONDAUER / SOUND9_A) ; i++)
+ if(!(MosfetOkay & 0x08))  { anz = 4; uart_putchar('a'); } else
  if(!(MosfetOkay & 0x10))  { anz = 5; uart_putchar('b'); } else
-       for(timer = 0; timer < SOUND9_E; timer++) PORTB |= 0x04; // Test B
+ if(!(MosfetOkay & 0x20))  { anz = 6; uart_putchar('c'); }
-       for(timer = 0; timer < SOUND9_A; timer++) PORTB = 0;
+ Delay_ms(300 * (4-ADR_TAB[MotorAdresse]));
     // zum Test der Hardware; Motor dreht mit konstanter Drehzahl ohne Regelung
     if(TEST_MANUELL)    Anwerfen(TEST_MANUELL);  // kommt von dort nicht wieder
     while (1)
+        {
+//ShowSense();
         if(!TEST_SCHUB)   PWM = SollwertErmittlung();
         //I2C_TXBuffer = PWM; // Antwort über I2C-Bus
         if(MANUELL_PWM)   PWM = MANUELL_PWM;

Subversion Repositories BL-Ctrl

(root)/tags/V0.42/main.c @ 110 - Rev 50 → 51