MSP430: Fix issues in function calls.
Tests: Adding LCD test.