Multiplex.cpp

00001 #include "mbed.h"
00002 
00003 
00004 float Temperatur_1 = 0, Temperatur_2 = 0, Temperatur_3 = 0, Aux = 0;
00005 float Motorspannung = 0, Motorstrom = 0, Bremsenspannung = 0, Bremsenstrom = 0;
00006 
00007 
00008 void read_sensors(void)
00009 {
00010     int  Messwert_0 = 0, Messwert_1 = 0;
00011  
00012     Multiplex_select_0 = 0, Multiplex_select_1 = 0;
00013  
00014     //Selection of Multiplexer states
00015  
00016     for (int i=0; i<=4; i++) {
00017          
00018         Multiplex_select_0 = i&0x01;
00019         Multiplex_select_1 = (i>>1)&0x01;
00020         wait(0.001);
00021  
00022         Messwert_0 = Messkanal_0.read_u16();
00023         Messwert_1 = Messkanal_1.read_u16();
00024  
00025         switch(i) {
00026             case 0: {
00027                 Temperatur_1 = Messwert_0 ;
00028                 Motorspannung = Messwert_1 * 0.000515 - 0.05 ; //Gute Näherung von 2- ~23V. Dannach zu niedrig.Z-Diode
00029                 break;
00030             }
00031  
00032             case 1: {
00033                 Temperatur_2 = Messwert_0  ;
00034                 Motorstrom = Messwert_1 * 0.000396 - 4.15;//
00035                 break;
00036             }
00037  
00038             case 2: {
00039                 Temperatur_3 = Messwert_0;
00040                 Bremsenspannung = Messwert_1 * 0.000515 - 0.05;//Gute Näherung von 2- ~23V. Dannach zu niedrig.Z-Diode
00041                 break;
00042             }
00043  
00044             case 3: {
00045                 Aux = Messwert_0 / 1629;
00046                 Bremsenstrom = Messwert_1; //* 0.00032 - 15.8;
00047                 break;
00048             }
00049  
00050  
00051         }
00052  
00053     }
00054 }