using System;
using System.IO;
using System.Runtime.InteropServices;
using System.Runtime.Versioning;
using System.Threading;
using NewLife;
namespace NewLife.XCoder.Tools.Can;
/// <summary>Linux SocketCAN 通é“(AF_CAN 原始套接å—)</summary>
/// <remarks>
/// æ³¢ç‰¹çŽ‡ç”±å†…æ ¸ä¾§è®¾ç½®ï¼Œä¸åœ¨åº”用里改:
/// sudo ip link set can0 type can bitrate 500000 && sudo ip link set up can0
/// æ— ç¡¬ä»¶æ—¶å¯ç”¨è™šæ‹Ÿç½‘å¡è”调:sudo modprobe vcan && sudo ip link add dev vcan0 type vcan && sudo ip link set up vcan0
/// </remarks>
[SupportedOSPlatform("linux")]
public sealed class SocketCanChannel : ICanChannel
{
#region å—æ®µ
private const Int32 AF_CAN = 29;
private const Int32 SOCK_RAW = 3;
private const Int32 CAN_RAW = 1;
private const Int32 CanFrameSize = 16;
private const UInt32 CanEffFlag = 0x80000000;
private const UInt32 CanRtrFlag = 0x40000000;
// setsockopt 傿•°ï¼šSOL_CAN_RAW=101ã€CAN_RAW_RECV_OWN_MSGS=4ï¼ˆé»˜è®¤ä¸æŽ¥æ”¶è‡ªå·±å‘的帧,调试工具需è¦èƒ½è‡ªæ”¶ï¼‰
private const Int32 SOL_CAN_RAW = 101;
private const Int32 CAN_RAW_RECV_OWN_MSGS = 4;
private readonly String _interface;
private Int32 _fd = -1;
private Thread? _reader;
private volatile Boolean _running;
#endregion
#region 属性
/// <summary>通é“å称(网å¡å,如 can0 / vcan0)</summary>
public String Name => _interface;
/// <summary>是å¦å·²æ‰“å¼€</summary>
public Boolean IsOpen => _fd >= 0;
/// <summary>当剿³¢ç‰¹çŽ‡ï¼›SocketCAN ç”±å†…æ ¸è®¾ç½®ï¼Œè¿™é‡Œåªè®°å½•界é¢é€‰æ‹©å€¼</summary>
public Int32 Bitrate { get; private set; }
/// <summary>收到帧事件,在åŽå°è¯»å–线程触å‘</summary>
public event EventHandler<CanFrame>? Received;
#endregion
#region æž„é€
/// <summary>实例化指定网å¡çš„ SocketCAN 通é“</summary>
/// <param name="interfaceName">网å¡å,如 can0 / vcan0</param>
public SocketCanChannel(String interfaceName)
{
if (interfaceName.IsNullOrEmpty()) throw new ArgumentNullException(nameof(interfaceName));
_interface = interfaceName;
}
#endregion
#region 打开/å…³é—
/// <summary>打开通é“å¹¶å¯åŠ¨æŽ¥æ”¶çº¿ç¨‹</summary>
/// <param name="bitrate">期望波特率,仅记录;实际速率请在系统侧设置网å¡</param>
public void Open(Int32 bitrate)
{
if (IsOpen) return;
var ifIndex = ReadIfIndex(_interface);
if (ifIndex <= 0) throw new InvalidOperationException($"ç½‘å¡ {_interface} ä¸å˜åœ¨æˆ–ä¸å¯ç”¨");
var fd = socket(AF_CAN, SOCK_RAW, CAN_RAW);
if (fd < 0) throw new InvalidOperationException($"创建 CAN 套接å—å¤±è´¥ï¼ˆéœ€è¦ root 或 CAP_NET_RAW):{Marshal.GetLastPInvokeErrorMessage()}");
// sockaddr_can:family(2)+填充(2)+ifindex(4)+rx_id/tx_id(8);rx_id=0 表示接收全部帧
var address = new Byte[16];
BitConverter.GetBytes((UInt16)AF_CAN).CopyTo(address, 0);
BitConverter.GetBytes(ifIndex).CopyTo(address, 4);
if (bind(fd, address, address.Length) != 0)
{
var error = Marshal.GetLastPInvokeErrorMessage();
close(fd);
throw new InvalidOperationException($"ç»‘å®šç½‘å¡ {_interface} 失败:{error}");
}
// å…许接收自己å‘出的帧(vcan 回环/啿œºè°ƒè¯•时需è¦ï¼‰
var on = BitConverter.GetBytes(1);
setsockopt(fd, SOL_CAN_RAW, CAN_RAW_RECV_OWN_MSGS, on, on.Length);
_fd = fd;
Bitrate = bitrate;
_running = true;
_reader = new Thread(ReadLoop) { IsBackground = true, Name = $"SocketCAN-{_interface}" };
_reader.Start();
}
/// <summary>å…³é—通é“å¹¶åœæ¢æŽ¥æ”¶çº¿ç¨‹</summary>
public void Close()
{
_running = false;
var fd = _fd;
_fd = -1;
if (fd >= 0)
{
try { close(fd); } catch { }
}
_reader = null;
}
/// <summary>释放通é“</summary>
public void Dispose() => Close();
#endregion
#region æ”¶å‘
/// <summary>å‘é€ä¸€å¸§</summary>
/// <param name="frame">CAN 帧,数æ®è¶…过 8 å—节会被截æ–(ç»å…¸ CAN)</param>
public void Send(CanFrame frame)
{
if (frame == null) throw new ArgumentNullException(nameof(frame));
if (!IsOpen) throw new InvalidOperationException("é€šé“æœªæ‰“å¼€");
var data = frame.Data ?? [];
if (data.Length > 8) data = data[..8];
var buffer = new Byte[CanFrameSize];
var id = frame.Id & 0x1FFFFFFF;
if (frame.Extended) id |= CanEffFlag;
if (frame.Remote) id |= CanRtrFlag;
BitConverter.GetBytes(id).CopyTo(buffer, 0);
buffer[4] = (Byte)data.Length;
data.CopyTo(buffer, 8);
if (write(_fd, buffer, buffer.Length) < 0)
throw new InvalidOperationException($"å‘é€å¤±è´¥ï¼š{Marshal.GetLastPInvokeErrorMessage()}");
}
private void ReadLoop()
{
var buffer = new Byte[CanFrameSize];
while (_running)
{
eintr:
var n = read(_fd, buffer, CanFrameSize);
if (n < 0)
{
var errno = Marshal.GetLastPInvokeError();
// EINTR æ˜¯ä¿¡å·æ‰“æ–,继ç»è¯»ï¼›å…¶ä½™é”™è¯¯åœ¨å…³é—åŽè§†ä¸ºæ£å¸¸é€€å‡º
if (errno == 4) goto eintr;
if (_running) Thread.Sleep(10);
continue;
}
if (n < CanFrameSize) continue;
var canId = BitConverter.ToUInt32(buffer, 0);
var dlc = buffer[4] > 8 ? 8 : buffer[4];
var data = new Byte[dlc];
Array.Copy(buffer, 8, data, 0, dlc);
var frame = new CanFrame(
canId & 0x1FFFFFFF,
data,
(canId & CanEffFlag) != 0,
(canId & CanRtrFlag) != 0);
try { Received?.Invoke(this, frame); } catch { }
}
}
#endregion
#region 辅助
/// <summary>从 sysfs 读å–网å¡ç´¢å¼•</summary>
/// <param name="name">网å¡å</param>
/// <returns>索引;读å–失败返回 0</returns>
public static Int32 ReadIfIndex(String name)
{
try
{
var text = File.ReadAllText($"/sys/class/net/{name}/ifindex").Trim();
return Int32.TryParse(text, out var index) ? index : 0;
}
catch
{
return 0;
}
}
/// <summary>ç½‘å¡æ˜¯å¦å¤„于 up 状æ€ï¼ˆsysfs 里的 operstate)</summary>
/// <param name="name">网å¡å</param>
/// <returns>æ˜¯å¦ up</returns>
public static Boolean IsUp(String name)
{
try
{
var state = File.ReadAllText($"/sys/class/net/{name}/operstate").Trim();
return state.Equals("up", StringComparison.OrdinalIgnoreCase) || state.Equals("unknown", StringComparison.OrdinalIgnoreCase);
}
catch
{
return false;
}
}
private static UInt16 ToUInt16(String text) => (UInt16)(UInt32.TryParse(text, out var v) ? v : 0);
[DllImport("libc", SetLastError = true)]
private static extern Int32 socket(Int32 domain, Int32 type, Int32 protocol);
[DllImport("libc", SetLastError = true)]
private static extern Int32 bind(Int32 fd, Byte[] addr, Int32 len);
[DllImport("libc", SetLastError = true)]
private static extern Int32 setsockopt(Int32 fd, Int32 level, Int32 optName, Byte[] optValue, Int32 len);
[DllImport("libc", SetLastError = true)]
private static extern nint read(Int32 fd, Byte[] buf, nint count);
[DllImport("libc", SetLastError = true)]
private static extern nint write(Int32 fd, Byte[] buf, nint count);
[DllImport("libc", SetLastError = true)]
private static extern Int32 close(Int32 fd);
#endregion
}
|