| ------------------------------------------------------------------------------ |
| -- -- |
| -- 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-2008, 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 2, 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. See the GNU General Public License -- |
| -- for more details. You should have received a copy of the GNU General -- |
| -- Public License distributed with GNAT; see file COPYING. If not, write -- |
| -- to the Free Software Foundation, 51 Franklin Street, Fifth Floor, -- |
| -- Boston, MA 02110-1301, USA. -- |
| -- -- |
| -- As a special exception, if other files instantiate generics from this -- |
| -- unit, or you link this unit with other files to produce an executable, -- |
| -- this unit does not by itself cause the resulting executable to be -- |
| -- covered by the GNU General Public License. This exception does not -- |
| -- however invalidate any other reasons why the executable file might be -- |
| -- covered by the GNU Public License. -- |
| -- -- |
| -- 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.CRTL; use System, System.CRTL; |
| |
| with GNAT.OS_Lib; use GNAT.OS_Lib; |
| |
| package body GNAT.Serial_Communications is |
| |
| 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"); |
| |
| O_RDWR : constant := 8#02#; |
| O_NOCTTY : constant := 8#0400#; |
| O_NDELAY : constant := 8#04000#; |
| FNDELAY : constant := O_NDELAY; |
| F_SETFL : constant := 4; |
| TCSANOW : constant := 0; |
| TCIFLUSH : constant := 0; |
| CLOCAL : constant := 8#04000#; |
| CREAD : constant := 8#0200#; |
| CSTOPB : constant := 8#0100#; |
| CRTSCTS : constant := 8#020000000000#; |
| PARENB : constant := 8#00400#; |
| PARODD : constant := 8#01000#; |
| |
| -- c_cc indexes |
| |
| VTIME : constant := 5; |
| VMIN : constant := 6; |
| |
| C_Data_Rate : constant array (Data_Rate) of unsigned := |
| (B1200 => 8#000011#, |
| B2400 => 8#000013#, |
| B4800 => 8#000014#, |
| B9600 => 8#000015#, |
| B19200 => 8#000016#, |
| B38400 => 8#000017#, |
| B57600 => 8#010001#, |
| B115200 => 8#010002#); |
| |
| C_Bits : constant array (Data_Bits) of unsigned := |
| (CS7 => 8#040#, CS8 => 8#060#); |
| |
| C_Stop_Bits : constant array (Stop_Bits_Number) of unsigned := |
| (One => 0, Two => CSTOPB); |
| |
| C_Parity : constant array (Parity_Check) of unsigned := |
| (None => 0, Odd => PARENB or PARODD, Even => 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 |
| 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 & " (" & Integer'Image (Error) & ')'; |
| 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 int := Buffer'Length; |
| Res : int; |
| |
| 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 |
| Last := 0; |
| Raise_Error ("read failed"); |
| else |
| Last := Buffer'First + Stream_Element_Offset (Res) - 1; |
| end if; |
| 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; |
| Timeout : Duration := 10.0) |
| is |
| 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; |
| |
| 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 CLOCAL |
| or CREAD |
| or CRTSCTS; |
| Current.c_lflag := 0; |
| Current.c_iflag := 0; |
| Current.c_oflag := 0; |
| 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 |
| |
| if Block then |
| Res := fcntl (int (Port.H.all), F_SETFL, 0); |
| else |
| Res := fcntl (int (Port.H.all), F_SETFL, FNDELAY); |
| end if; |
| |
| 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 int := Buffer'Length; |
| Res : int; |
| |
| begin |
| if Port.H = null then |
| Raise_Error ("write: port not opened", 0); |
| end if; |
| |
| Res := write (int (Port.H.all), Buffer'Address, Len); |
| pragma Assert (Res = Len); |
| |
| if Res = -1 then |
| Raise_Error ("write failed"); |
| end if; |
| 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; |