#include #include "v25.h" void new_divider(unsigned new_md) { unsigned char tmp; #ifdef PRESCALE_BY_6 pokeregb(V25_TMC1,0x80); /* set clk/6 */ #else pokeregb(V25_TMC1,0xC0); /* set clk/128 */ #endif tmp = peekregb(V25_TMC1) & ~TS1; /* stop count */ pokeregb(V25_TMC1,tmp); pokeregw(V25_MD1,new_md); pokeregb(V25_TMC1,tmp | TS1); /* start count */ }