fixed type issue in initSoftwareUart. char -> byte
set variable in wrong scope in setServoPosition