Found another way to achieve relatively precise stepping! I wanted to first use two timer compare interrupts, but then i though about it for a day, and found out that i can do it with one (with a cost of potential precision, which can be compensated for), and other libraries do it like this too!