Add strlen function and initial shell function that handles the input characters from USART2