-void substractOffset(struct rpi_in* data, struct rpi_in* offset){
- data->pozice-=offset->pozice;
- return;
-}
-/*
- * pocita procentualni odchylku od prumerneho proudu
- */
-float diff_p(float value){
- return ((float)value-PRUM_PROUD)*100/PRUM_PROUD;
-}
-/*
- * pocita procentualni odchylku od prumerneho souctu proudu
- */
-float diff_s(float value){
- return ((float)value-PRUM_SOUC)*100/PRUM_SOUC;
-}
-/*
- * tiskne potrebna data
- */
-void printData(struct rpi_in data){
- float cur0, cur1, cur2;
- if (data.adc_m_count){
- cur0=data.ch0/data.adc_m_count;
- cur1=data.ch1/data.adc_m_count;
- cur2=data.ch2/data.adc_m_count;
- }
- printf("\npozice=%d\n",(int32_t)data.pozice);
- printf("hal1=%d, hal2=%d, hal3=%d\n",data.hal1,data.hal2,data.hal3);
- //printf("en1=%d, en2=%d, en3=%d (Predchozi hodnoty)\n",data.en1,data.en2,data.en3);
- //printf("shdn1=%d, shdn2=%d, shdn3=%d (P.h.)\n",data.shdn1,data.shdn2,data.shdn3);
- //printf("PWM1(10d5)b54=%d %d %d %d %d %d=b49(P.h.)\n",data.b54,data.b53,data.b52,data.b51,data.b50,data.b49);
- //printf("PWM2(10d4)b48=%d %d %d %d %d %d %d=b42(P.h.)\n",data.b48,data.b47,data.b46,data.b45,data.b44,data.b43,data.b42);
- //printf("PWM3(10d5)b41=%d %d %d %d %d %d=b36(P.h.)\n",data.b41,data.b40,data.b39,data.b38,data.b37,data.b36);
- printf("Pocet namerenych proudu=%u\n",data.adc_m_count);
- printf("(pwm1)proud1 (ch1)=%d (avg=%4.0f) (%2.2f%%)\n",data.ch1,cur1,diff_p(cur1));
- printf("(pwm2)proud2 (ch2)=%d (avg=%4.0f)(%2.2f%%)\n",data.ch2,cur2,diff_p(cur2));
- printf("(pwm3)proud3 (ch0)=%d (avg=%4.0f)(%2.2f%%)\n",data.ch0,cur0,diff_p(cur0));
- printf("soucet prumeru=%5.0f (%2.2f%%)\n",cur0+cur1+cur2,diff_s(cur0+cur1+cur2));
-}
-void prepare_tx(uint8_t * tx){
-
- /*Data format:
- * tx[0] - bity 95 downto 88 - bits that are sent first
- * tx[1] - bity 87 downto 80
- * tx[2] - bity 79 downto 72
- * tx[3] - bity 71 downto 64
- * tx[4] - bity 63 downto 56
- * tx[5] - bity 55 downto 48
- * tx[6] - bity 47 downto 40
- * tx[7] - bity 39 downto 32
- * tx[8] - bity 31 downto 24
- * tx[9] - bity 23 downto 16
- * tx[10] - bity 15 downto 8
- * tx[11] - bity 7 downto 0
- *
- * bit 95 - ADC reset
- * bit 94 - enable PWM1
- * bit 93 - enable PWM2
- * bit 92 - enable PWM3
- * bit 91 - shutdown1
- * bit 90 - shutdown2
- * bit 89 - shutdown3
- * .
- * .
- * .
- * bits 34 .. 24 - match PWM1
- * bits 23 .. 13 - match PWM2
- * bit 11,12 - Unused
- * bits 10 .. 0 - match PWM3
- */
-
-
- uint16_t tmp;
-
- /* keep the cap*/
- if (pwm1>2047) pwm1=2047;
- if (pwm2>2047) pwm2=2047;
- if (pwm3>2047) pwm3=2047;
-
- tx[0]=test; /*bit 94 - enable PWM1*/
-
- /*pwm1*/
- tx[7]=(tx[7] & 0xF8) | (0x07 & ((uint8_t*)&pwm1)[1]); /*MSB*/
- tx[8]=((uint8_t*)&pwm1)[0]; /*LSB*/
-
- /*pwm2*/
- tmp=pwm2;
- tmp<<=5;
- tx[9]=((uint8_t*)&tmp)[1]; /*MSB*/
- tx[10]=(tx[10] & 0x1F) | (0xE0 & ((uint8_t*)&tmp)[0]); /*LSB*/
-
- /*pwm3*/
- tx[10]=(tx[10] & 0xF8) | (0x07 & ((uint8_t*)&pwm3)[1]); /*MSB*/
- tx[11]=((uint8_t*)&pwm3)[0]; /*LSB*/
-
-
-}