Fixed some bugs, now using serialport gem