Arduino HexBug: adding HexBug commands. Not complete