Started adding capsule support, still not working
fixes and improvements in serialprint.py
motor on/off every 50 ms