313 lines
9.7 KiB
Ada
313 lines
9.7 KiB
Ada
------------------------------------------------------------------------------
|
|
-- --
|
|
-- 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-2015, 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 :=
|
|
(B75 => OSC.B75,
|
|
B110 => OSC.B110,
|
|
B150 => OSC.B150,
|
|
B300 => OSC.B300,
|
|
B600 => OSC.B600,
|
|
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;
|