big commit, improve servo movement, improve cosm function, add interupt blink