51单片机通过UDN2916驱动双极性两相四线步进电机转动，程序如下。请问怎么算转速。