Improved overall speed

Improved serial speed communication by removing the sleep(0.02) and
adding a while that waits until a message starts with $… also remove
the flushes, non needed… asking and receiving data takes 0.016, aprox
62.5hz.