- dat_reg(95 downto 64) <= position(31 downto 0); --pozice
- dat_reg(63 downto 61) <= hal_in(1 to 3); --halovy sondy
- dat_reg(60 downto 58) <= pwm_en_p(1 to 3); --enable positive
- dat_reg(57 downto 55) <= pwm_en_n(1 to 3); --shutdown
- dat_reg(54 downto 49) <= pwm_match(1)(10 downto 5); --6 MSb of PWM1
- dat_reg(48 downto 42) <= pwm_match(2)(10 downto 4); --7 MSb of PWM2
- dat_reg(41 downto 36) <= pwm_match(3)(10 downto 5); --6 MSb of PWM3
- dat_reg(35 downto 0) <= adc_channels(35 downto 0); --current mesurments
+ dat_reg(127 downto 96) <= position(31 downto 0); --pozice
+ dat_reg(95 downto 93) <= hal_in(1 to 3); --halovy sondy
+ dat_reg(92 downto 90) <= pwm_en_p(1 to 3); --enable positive
+ dat_reg(89 downto 87) <= pwm_en_n(1 to 3); --shutdown
+ dat_reg(86 downto 81) <= (others=>'0');--pwm_match(1)(10 downto 5); --6 MSb of PWM1
+ dat_reg(80 downto 72) <=adc_m_count(8 downto 0); --count of measurments
+ --data order schould be: ch2 downto ch0 downto ch1
+ dat_reg(71 downto 0) <= adc_channels(71 downto 0); --current mesurments