Misc. fixes.
Missing a needed header.
Fixed up the commands a bit. Had problems using them inside Serial methods because of the write method.