Update Serial Interface

• Implement some kind of correctness checking codes, especially important for path data
• Move packetizing into serial_write function from take_path
• Implement return values over Serial