| ------------------------------------------------------------------------------ |
| -- -- |
| -- GNAT COMPILER COMPONENTS -- |
| -- -- |
| -- G N A T . S E R I A L _ C O M M U N I C A T I O N S -- |
| -- -- |
| -- B o d y -- |
| -- -- |
| -- Copyright (C) 2007-2013, AdaCore -- |
| -- -- |
| -- GNAT is free software; you can redistribute it and/or modify it under -- |
| -- terms of the GNU General Public License as published by the Free Soft- -- |
| -- ware Foundation; either version 3, or (at your option) any later ver- -- |
| -- sion. GNAT is distributed in the hope that it will be useful, but WITH- -- |
| -- OUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY -- |
| -- or FITNESS FOR A PARTICULAR PURPOSE. -- |
| -- -- |
| -- As a special exception under Section 7 of GPL version 3, you are granted -- |
| -- additional permissions described in the GCC Runtime Library Exception, -- |
| -- version 3.1, as published by the Free Software Foundation. -- |
| -- -- |
| -- You should have received a copy of the GNU General Public License and -- |
| -- a copy of the GCC Runtime Library Exception along with this program; -- |
| -- see the files COPYING3 and COPYING.RUNTIME respectively. If not, see -- |
| -- <http://www.gnu.org/licenses/>. -- |
| -- -- |
| -- GNAT was originally developed by the GNAT team at New York University. -- |
| -- Extensive contributions were provided by Ada Core Technologies Inc. -- |
| -- -- |
| ------------------------------------------------------------------------------ |
| |
| -- This is the GNU/Linux implementation of this package |
| |
| with Ada.Streams; use Ada.Streams; |
| with Ada; use Ada; |
| with Ada.Unchecked_Deallocation; |
| |
| with System; use System; |
| with System.Communication; use System.Communication; |
| with System.CRTL; use System.CRTL; |
| with System.OS_Constants; |
| |
| with GNAT.OS_Lib; use GNAT.OS_Lib; |
| |
| package body GNAT.Serial_Communications is |
| |
| package OSC renames System.OS_Constants; |
| |
| use type Interfaces.C.unsigned; |
| |
| type Port_Data is new int; |
| |
| subtype unsigned is Interfaces.C.unsigned; |
| subtype char is Interfaces.C.char; |
| subtype unsigned_char is Interfaces.C.unsigned_char; |
| |
| function fcntl (fd : int; cmd : int; value : int) return int; |
| pragma Import (C, fcntl, "fcntl"); |
| |
| C_Data_Rate : constant array (Data_Rate) of unsigned := |
| (B1200 => OSC.B1200, |
| B2400 => OSC.B2400, |
| B4800 => OSC.B4800, |
| B9600 => OSC.B9600, |
| B19200 => OSC.B19200, |
| B38400 => OSC.B38400, |
| B57600 => OSC.B57600, |
| B115200 => OSC.B115200); |
| |
| C_Bits : constant array (Data_Bits) of unsigned := |
| (CS7 => OSC.CS7, CS8 => OSC.CS8); |
| |
| C_Stop_Bits : constant array (Stop_Bits_Number) of unsigned := |
| (One => 0, Two => OSC.CSTOPB); |
| |
| C_Parity : constant array (Parity_Check) of unsigned := |
| (None => 0, |
| Odd => OSC.PARENB or OSC.PARODD, |
| Even => OSC.PARENB); |
| |
| procedure Raise_Error (Message : String; Error : Integer := Errno); |
| pragma No_Return (Raise_Error); |
| |
| ---------- |
| -- Name -- |
| ---------- |
| |
| function Name (Number : Positive) return Port_Name is |
| N : constant Natural := Number - 1; |
| N_Img : constant String := Natural'Image (N); |
| begin |
| return Port_Name ("/dev/ttyS" & N_Img (N_Img'First + 1 .. N_Img'Last)); |
| end Name; |
| |
| ---------- |
| -- Open -- |
| ---------- |
| |
| procedure Open |
| (Port : out Serial_Port; |
| Name : Port_Name) |
| is |
| use OSC; |
| |
| C_Name : constant String := String (Name) & ASCII.NUL; |
| Res : int; |
| |
| begin |
| if Port.H = null then |
| Port.H := new Port_Data; |
| end if; |
| |
| Port.H.all := Port_Data (open |
| (C_Name (C_Name'First)'Address, int (O_RDWR + O_NOCTTY + O_NDELAY))); |
| |
| if Port.H.all = -1 then |
| Raise_Error ("open: open failed"); |
| end if; |
| |
| -- By default we are in blocking mode |
| |
| Res := fcntl (int (Port.H.all), F_SETFL, 0); |
| |
| if Res = -1 then |
| Raise_Error ("open: fcntl failed"); |
| end if; |
| end Open; |
| |
| ----------------- |
| -- Raise_Error -- |
| ----------------- |
| |
| procedure Raise_Error (Message : String; Error : Integer := Errno) is |
| begin |
| raise Serial_Error with Message |
| & (if Error /= 0 |
| then " (" & Errno_Message (Err => Error) & ')' |
| else ""); |
| end Raise_Error; |
| |
| ---------- |
| -- Read -- |
| ---------- |
| |
| overriding procedure Read |
| (Port : in out Serial_Port; |
| Buffer : out Stream_Element_Array; |
| Last : out Stream_Element_Offset) |
| is |
| Len : constant size_t := Buffer'Length; |
| Res : ssize_t; |
| |
| begin |
| if Port.H = null then |
| Raise_Error ("read: port not opened", 0); |
| end if; |
| |
| Res := read (Integer (Port.H.all), Buffer'Address, Len); |
| |
| if Res = -1 then |
| Raise_Error ("read failed"); |
| end if; |
| |
| Last := Last_Index (Buffer'First, size_t (Res)); |
| end Read; |
| |
| --------- |
| -- Set -- |
| --------- |
| |
| procedure Set |
| (Port : Serial_Port; |
| Rate : Data_Rate := B9600; |
| Bits : Data_Bits := CS8; |
| Stop_Bits : Stop_Bits_Number := One; |
| Parity : Parity_Check := None; |
| Block : Boolean := True; |
| Local : Boolean := True; |
| Flow : Flow_Control := None; |
| Timeout : Duration := 10.0) |
| is |
| use OSC; |
| |
| type termios is record |
| c_iflag : unsigned; |
| c_oflag : unsigned; |
| c_cflag : unsigned; |
| c_lflag : unsigned; |
| c_line : unsigned_char; |
| c_cc : Interfaces.C.char_array (0 .. 31); |
| c_ispeed : unsigned; |
| c_ospeed : unsigned; |
| end record; |
| pragma Convention (C, termios); |
| |
| function tcgetattr (fd : int; termios_p : Address) return int; |
| pragma Import (C, tcgetattr, "tcgetattr"); |
| |
| function tcsetattr |
| (fd : int; action : int; termios_p : Address) return int; |
| pragma Import (C, tcsetattr, "tcsetattr"); |
| |
| function tcflush (fd : int; queue_selector : int) return int; |
| pragma Import (C, tcflush, "tcflush"); |
| |
| Current : termios; |
| |
| Res : int; |
| pragma Warnings (Off, Res); |
| -- Warnings off, since we don't always test the result |
| |
| begin |
| if Port.H = null then |
| Raise_Error ("set: port not opened", 0); |
| end if; |
| |
| -- Get current port settings |
| |
| Res := tcgetattr (int (Port.H.all), Current'Address); |
| |
| -- Change settings now |
| |
| Current.c_cflag := C_Data_Rate (Rate) |
| or C_Bits (Bits) |
| or C_Stop_Bits (Stop_Bits) |
| or C_Parity (Parity) |
| or CREAD; |
| Current.c_iflag := 0; |
| Current.c_lflag := 0; |
| Current.c_oflag := 0; |
| |
| if Local then |
| Current.c_cflag := Current.c_cflag or CLOCAL; |
| end if; |
| |
| case Flow is |
| when None => |
| null; |
| when RTS_CTS => |
| Current.c_cflag := Current.c_cflag or CRTSCTS; |
| when Xon_Xoff => |
| Current.c_iflag := Current.c_iflag or IXON; |
| end case; |
| |
| Current.c_ispeed := Data_Rate_Value (Rate); |
| Current.c_ospeed := Data_Rate_Value (Rate); |
| Current.c_cc (VMIN) := char'Val (0); |
| Current.c_cc (VTIME) := char'Val (Natural (Timeout * 10)); |
| |
| -- Set port settings |
| |
| Res := tcflush (int (Port.H.all), TCIFLUSH); |
| Res := tcsetattr (int (Port.H.all), TCSANOW, Current'Address); |
| |
| -- Block |
| |
| Res := fcntl (int (Port.H.all), F_SETFL, (if Block then 0 else FNDELAY)); |
| |
| if Res = -1 then |
| Raise_Error ("set: fcntl failed"); |
| end if; |
| end Set; |
| |
| ----------- |
| -- Write -- |
| ----------- |
| |
| overriding procedure Write |
| (Port : in out Serial_Port; |
| Buffer : Stream_Element_Array) |
| is |
| Len : constant size_t := Buffer'Length; |
| Res : ssize_t; |
| |
| begin |
| if Port.H = null then |
| Raise_Error ("write: port not opened", 0); |
| end if; |
| |
| Res := write (int (Port.H.all), Buffer'Address, Len); |
| |
| if Res = -1 then |
| Raise_Error ("write failed"); |
| end if; |
| |
| pragma Assert (size_t (Res) = Len); |
| end Write; |
| |
| ----------- |
| -- Close -- |
| ----------- |
| |
| procedure Close (Port : in out Serial_Port) is |
| procedure Unchecked_Free is |
| new Unchecked_Deallocation (Port_Data, Port_Data_Access); |
| |
| Res : int; |
| pragma Unreferenced (Res); |
| |
| begin |
| if Port.H /= null then |
| Res := close (int (Port.H.all)); |
| Unchecked_Free (Port.H); |
| end if; |
| end Close; |
| |
| end GNAT.Serial_Communications; |
