La idea es buena. Para medir la velocidad yo dibujé un círculo de plástico con varios diámetros en negro, le hice un agujero en el centro y lo pegué al eje del motor, luego puse un optoacoplador de ranura entre el círculo para medir los pulsos y al PIC.
Este proyecto ya se hizo y se llegó a buen puerto, me acuerdo porque ayudé a su realización. Búscalo que debe de estar aquí en este subFORO de C o en el de proyectos.
Un saludo