(1) Adding a delay after sending command to allow the uart to recive. (2) Updated the tests. Now it works nicely.