Refactored Queue array funcs, added return value.
Updated Serial read and write functions.