This was the best solution I found, 100% Lego, no Lego part modified, small size (I think it could be still smaller):
I used the old RCX motors, but you can use any Lego motor [Edited: or non Lego motor, no servo needed].
You can view how it works in this video: