SW: Add function to send commands to monitor.
SW: Add command definitions and monitor self test.