[Serial] Added test program and untested cpp wrapper