Added takeFrameFromSerial which helps circumvent complicated Serial API
Added test to read length from cts message -> works
Refactoring lot of stuff to make code more simple