//Wysyła wiadomość do robota jeżeli port COM jest otwarty
        private void SendToRobot(object sender, SendDataEventArgs e)
        {
            if (serialPort.IsOpen)
            {
                string s;
                if (e.args != null)
                {
                    s = e.command + " " + e.args;
                }
                else
                {
                    s = e.command;
                }

                serialPort.Write(s + "\r");
                lastSendCommand = e.command;
                AddToLog("Send: " + s);
                UpdateRobotData(e.command);
                //AddToLog("Last command: " + e.command);
                //AddToLog("Last args: " + e.args);
            }
        }
 protected virtual void OnDataSend(SendDataEventArgs e)
 {
     DataSend?.Invoke(this, e);
 }