PM publish
Fork of PowerMonlib2 by
PowerMon.h@2:01b627381f0d, 2018-08-13 (annotated)
- Committer:
- worasuchad
- Date:
- Mon Aug 13 11:39:08 2018 +0000
- Revision:
- 2:01b627381f0d
- Parent:
- 1:7a6a568c5c34
hormone v.1 for optimizing COT
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
worasuchad | 2:01b627381f0d | 1 | #define i2c2_sda D3 //D14 |
worasuchad | 2:01b627381f0d | 2 | #define i2c2_scl D6 //D15 |
sippasaeng | 0:6615da7486d0 | 3 | |
sippasaeng | 0:6615da7486d0 | 4 | #define SourceVH 0x58 |
sippasaeng | 0:6615da7486d0 | 5 | #define SourceVL 0x59 |
sippasaeng | 0:6615da7486d0 | 6 | #define SenseVH 0x54 |
sippasaeng | 0:6615da7486d0 | 7 | #define SenseVL 0x55 |
sippasaeng | 0:6615da7486d0 | 8 | #define PowerH 0x5B |
sippasaeng | 0:6615da7486d0 | 9 | #define PowerL 0x5C |
sippasaeng | 0:6615da7486d0 | 10 | |
worasuchad | 2:01b627381f0d | 11 | I2C i2c2_PM(i2c2_sda, i2c2_scl); |
sippasaeng | 0:6615da7486d0 | 12 | |
worasuchad | 2:01b627381f0d | 13 | class powerMon |
worasuchad | 2:01b627381f0d | 14 | { |
worasuchad | 2:01b627381f0d | 15 | private: |
worasuchad | 2:01b627381f0d | 16 | int w_addr,r_addr; |
sippasaeng | 0:6615da7486d0 | 17 | |
worasuchad | 2:01b627381f0d | 18 | public: |
worasuchad | 2:01b627381f0d | 19 | powerMon(int addr_sel) |
worasuchad | 2:01b627381f0d | 20 | { |
worasuchad | 2:01b627381f0d | 21 | switch(addr_sel) |
worasuchad | 2:01b627381f0d | 22 | { |
worasuchad | 2:01b627381f0d | 23 | case 0: w_addr=0x98; break; |
worasuchad | 2:01b627381f0d | 24 | case 100: w_addr=0x9A; break; |
worasuchad | 2:01b627381f0d | 25 | case 180: w_addr=0x9C; break; |
worasuchad | 2:01b627381f0d | 26 | case 300: w_addr=0x9E; break; |
worasuchad | 2:01b627381f0d | 27 | case 430: w_addr=0x90; break; |
worasuchad | 2:01b627381f0d | 28 | case 560: w_addr=0x92; break; |
worasuchad | 2:01b627381f0d | 29 | case 750: w_addr=0x94; break; |
worasuchad | 2:01b627381f0d | 30 | case 1270: w_addr=0x96; break; |
worasuchad | 2:01b627381f0d | 31 | case 1600: w_addr=0x50; break; |
worasuchad | 2:01b627381f0d | 32 | case 2000: w_addr=0x52; break; |
worasuchad | 2:01b627381f0d | 33 | case 2700: w_addr=0x54; break; |
worasuchad | 2:01b627381f0d | 34 | case 3600: w_addr=0x56; break; |
worasuchad | 2:01b627381f0d | 35 | case 5600: w_addr=0x58; break; |
worasuchad | 2:01b627381f0d | 36 | case 9100: w_addr=0x58; break; |
worasuchad | 2:01b627381f0d | 37 | case 20000: w_addr=0x5A; break; |
worasuchad | 2:01b627381f0d | 38 | case -1: w_addr=0x30; break; |
worasuchad | 2:01b627381f0d | 39 | } |
worasuchad | 2:01b627381f0d | 40 | r_addr = w_addr + 0x01; |
sippasaeng | 0:6615da7486d0 | 41 | } |
sippasaeng | 0:6615da7486d0 | 42 | |
worasuchad | 2:01b627381f0d | 43 | double V_Sense() |
worasuchad | 2:01b627381f0d | 44 | { |
worasuchad | 2:01b627381f0d | 45 | double volt=0,mult_fac=1,offset=0; |
worasuchad | 2:01b627381f0d | 46 | char buffer[2]; |
worasuchad | 2:01b627381f0d | 47 | buffer[0]=SenseVL; |
worasuchad | 2:01b627381f0d | 48 | i2c2_PM.write(r_addr,buffer, 1,true); |
worasuchad | 2:01b627381f0d | 49 | i2c2_PM.read(r_addr, buffer,1); |
worasuchad | 2:01b627381f0d | 50 | volt=buffer[0]/16; |
worasuchad | 2:01b627381f0d | 51 | buffer[0]=SenseVH; |
worasuchad | 2:01b627381f0d | 52 | i2c2_PM.write(r_addr,buffer, 1,true); |
worasuchad | 2:01b627381f0d | 53 | i2c2_PM.read(r_addr, buffer,1); |
worasuchad | 2:01b627381f0d | 54 | volt += (buffer[0] & 0x7f)*16; |
worasuchad | 2:01b627381f0d | 55 | volt = (volt*mult_fac)+offset; |
worasuchad | 2:01b627381f0d | 56 | return (buffer[0]&0x80)?-volt:volt; |
worasuchad | 2:01b627381f0d | 57 | } |
worasuchad | 2:01b627381f0d | 58 | |
worasuchad | 2:01b627381f0d | 59 | double V_Source() |
worasuchad | 2:01b627381f0d | 60 | { |
worasuchad | 2:01b627381f0d | 61 | double volt=0; |
worasuchad | 2:01b627381f0d | 62 | char buffer[2]; |
worasuchad | 2:01b627381f0d | 63 | buffer[0]=SourceVL; |
worasuchad | 2:01b627381f0d | 64 | i2c2_PM.write(r_addr,buffer, 1,true); |
worasuchad | 2:01b627381f0d | 65 | i2c2_PM.read(r_addr, buffer,1); |
worasuchad | 2:01b627381f0d | 66 | volt=buffer[0]/32; |
worasuchad | 2:01b627381f0d | 67 | buffer[0]=SourceVH; |
worasuchad | 2:01b627381f0d | 68 | i2c2_PM.write(r_addr,buffer, 1,true); |
worasuchad | 2:01b627381f0d | 69 | i2c2_PM.read(r_addr, buffer,1); |
worasuchad | 2:01b627381f0d | 70 | volt += buffer[0]*8; |
worasuchad | 2:01b627381f0d | 71 | |
worasuchad | 2:01b627381f0d | 72 | return (volt/2048.0000)*23.9883; |
worasuchad | 2:01b627381f0d | 73 | } |
worasuchad | 2:01b627381f0d | 74 | |
worasuchad | 2:01b627381f0d | 75 | double Current() |
worasuchad | 2:01b627381f0d | 76 | { |
worasuchad | 2:01b627381f0d | 77 | return (V_Sense()/2047.0000)*(8.0000); |
worasuchad | 2:01b627381f0d | 78 | } |
worasuchad | 2:01b627381f0d | 79 | |
worasuchad | 2:01b627381f0d | 80 | long Power_Ratio() |
worasuchad | 2:01b627381f0d | 81 | { |
worasuchad | 2:01b627381f0d | 82 | long power_r=0; |
worasuchad | 2:01b627381f0d | 83 | char buffer[2]; |
worasuchad | 2:01b627381f0d | 84 | buffer[0]=PowerL; |
worasuchad | 2:01b627381f0d | 85 | i2c2_PM.write(r_addr,buffer, 1,true); |
worasuchad | 2:01b627381f0d | 86 | i2c2_PM.read(r_addr, buffer,1); |
worasuchad | 2:01b627381f0d | 87 | power_r=buffer[0]; |
worasuchad | 2:01b627381f0d | 88 | buffer[0]=PowerH; |
worasuchad | 2:01b627381f0d | 89 | i2c2_PM.write(r_addr,buffer, 1,true); |
worasuchad | 2:01b627381f0d | 90 | i2c2_PM.read(r_addr, buffer,1); |
worasuchad | 2:01b627381f0d | 91 | power_r += buffer[0]*256; |
worasuchad | 2:01b627381f0d | 92 | |
worasuchad | 2:01b627381f0d | 93 | return power_r; |
worasuchad | 2:01b627381f0d | 94 | } |
worasuchad | 2:01b627381f0d | 95 | |
worasuchad | 2:01b627381f0d | 96 | double Power() |
worasuchad | 2:01b627381f0d | 97 | { |
worasuchad | 2:01b627381f0d | 98 | return (Power_Ratio()/65535.0000)*(8.0000*23.9883); |
worasuchad | 2:01b627381f0d | 99 | } |
sippasaeng | 0:6615da7486d0 | 100 | }; |