baldor control: fix: strong jump at beginning avoided, raw_pos_last=raw_pos for first measurement