447 lines
12 KiB
C#
447 lines
12 KiB
C#
using System;
|
||
using System.Collections.Generic;
|
||
using System.Linq;
|
||
using System.Text;
|
||
using System.Threading.Tasks;
|
||
|
||
using TSMaster;
|
||
|
||
namespace Can
|
||
{
|
||
class ToSunDevice : CanDevice
|
||
{
|
||
private string Name = "666";
|
||
|
||
|
||
private TCANQueueEvent CanQueueEvent;
|
||
private TCANFDQueueEvent CanFdQueueEvent;
|
||
|
||
public ToSunDevice()
|
||
{
|
||
this.CanQueueEvent = new TCANQueueEvent(OnCANRxEvent);
|
||
this.CanFdQueueEvent = new TCANFDQueueEvent(OnCANFDRxEvent);
|
||
}
|
||
|
||
~ToSunDevice()
|
||
{
|
||
//释放所有资源
|
||
TsMasterApi.finalize_lib_tsmaster();
|
||
}
|
||
|
||
|
||
//标准CAN
|
||
#region CAN
|
||
|
||
//CAN初始化
|
||
public override string CanInit()
|
||
{
|
||
//释放所有资源
|
||
//TsMasterApi.finalize_lib_tsmaster();
|
||
|
||
TsMasterApi.initialize_lib_tsmaster(Name);
|
||
|
||
//创建通道数
|
||
if ((TsMasterApi.tsapp_set_can_channel_count(1) == 0)
|
||
&& (TsMasterApi.tsapp_set_lin_channel_count(0) == 0)
|
||
)
|
||
{
|
||
|
||
}
|
||
else
|
||
{
|
||
return "创建通道失败";
|
||
}
|
||
|
||
TsMasterApi.tsapp_set_lin_channel_count(0);
|
||
|
||
/*int hardwareNum = 0;
|
||
TsMasterApi.tsapp_enumerate_hw_devices(out hardwareNum);
|
||
|
||
TLIBHWInfo tmpDeviceInfo = new TLIBHWInfo(0);
|
||
TsMasterApi.tsapp_get_hw_info_by_index(0, ref tmpDeviceInfo);*/
|
||
|
||
#if true
|
||
//创建通道映射
|
||
if (TsMasterApi.tsapp_set_mapping_verbose(Name, TLIBApplicationChannelType.APP_CAN,
|
||
APP_CHANNEL.CHN1, "TC1012", TLIBBusToolDeviceType.TS_USB_DEVICE, 12, 0, HARDWARE_CHANNEL.CHN1) == 0) //12
|
||
#else
|
||
if (TsMasterApi.tsapp_set_mapping_verbose(Name, TLIBApplicationChannelType.APP_CAN,
|
||
APP_CHANNEL.CHN1, "TC1011", TLIBBusToolDeviceType.TS_USB_DEVICE, 5, 0, HARDWARE_CHANNEL.CHN1) == 0) //12
|
||
#endif
|
||
{
|
||
|
||
}
|
||
else
|
||
{
|
||
return "创建通道映射失败";
|
||
}
|
||
|
||
|
||
#if true
|
||
//初始化通道参数
|
||
if (TsMasterApi.tsapp_configure_baudrate_can((int)APP_CHANNEL.CHN1, 500, false, true) != 0)
|
||
{
|
||
return "创建通道参数失败";
|
||
}
|
||
|
||
#else
|
||
if (TsMasterApi.tsapp_configure_can_regs(APP_CHANNEL.CHN1, 500, 7, 1, 1, 1, 0) != 0)
|
||
{
|
||
return "创建通道参数失败";
|
||
}
|
||
//tsapp_configure_can_regs(APP_CHANNEL AIdxChn, float ABaudrateKbps, int ASEG1, int ASEG2, int APrescaler, int ASJW, int A120OhmConnected);
|
||
#endif
|
||
|
||
|
||
|
||
//连接application：连接硬件通道并开启接收FIFO
|
||
int ret = TsMasterApi.tsapp_connect();
|
||
string connectResult = TsMasterApi.tsapp_get_error_description(ret);
|
||
if (0 == ret)
|
||
{
|
||
TsMasterApi.tsfifo_enable_receive_fifo();
|
||
}
|
||
else
|
||
{
|
||
//Log(connectResult);
|
||
//Log("Connect Application Failed! Please check the mapping table and whether the Hardware is Ready?!");
|
||
return "连接设备失败";
|
||
}
|
||
|
||
|
||
TsMasterApi.tsapp_unregister_events_all((IntPtr)0);
|
||
//注册接收回调函数：在每一次的回调函数vCANQueueEventObj中刷新数据段
|
||
/*if (0 == TsMasterApi.tsapp_register_event_can((IntPtr)0, CanQueueEvent))
|
||
{
|
||
|
||
}
|
||
else
|
||
{
|
||
return "创建接受报文事件失败";
|
||
}*/
|
||
|
||
|
||
return "OK";
|
||
|
||
|
||
}
|
||
|
||
|
||
//CAN逆初始化
|
||
public override string CanDeInit()
|
||
{
|
||
base.CanDeInit();
|
||
|
||
TsMasterApi.tsapp_unregister_events_all((IntPtr)0);
|
||
if(0 == TsMasterApi.tsapp_disconnect()
|
||
)
|
||
{
|
||
base.CanDeInit();
|
||
return "OK";
|
||
}
|
||
else
|
||
{
|
||
return "断开连接失败";
|
||
}
|
||
}
|
||
|
||
public override string CanReceiveEventEnable()
|
||
{
|
||
string ret;
|
||
|
||
//注册接收回调函数：在每一次的回调函数vCANQueueEventObj中刷新数据段
|
||
if (0 == TsMasterApi.tsapp_register_event_can((IntPtr)0, CanQueueEvent))
|
||
{
|
||
ret = "OK";
|
||
}
|
||
else
|
||
{
|
||
ret = "创建接受报文事件失败";
|
||
}
|
||
|
||
return ret;
|
||
}
|
||
|
||
|
||
public override string CanReceiveEventDisable()
|
||
{
|
||
string ret;
|
||
|
||
if (0 == TsMasterApi.tsapp_unregister_events_all((IntPtr)0))
|
||
{
|
||
ret = "OK";
|
||
}
|
||
else
|
||
{
|
||
ret = "失能接收事件失败";
|
||
}
|
||
|
||
return ret;
|
||
}
|
||
|
||
|
||
public override string CanSetFilter(UInt32 stratId, UInt32 endId)
|
||
{
|
||
//清除所有过滤器
|
||
for (int i = 0; i < 0x7ff; i++)
|
||
{
|
||
TsMasterApi.tsfifo_delete_can_canfd_pass_filter(APP_CHANNEL.CHN1, (int)i);
|
||
}
|
||
|
||
//设置过滤
|
||
for(UInt32 i = stratId; i <= endId; i++)
|
||
{
|
||
TsMasterApi.tsfifo_add_can_canfd_pass_filter(APP_CHANNEL.CHN1, (int)i, true);
|
||
}
|
||
|
||
return "OK";
|
||
}
|
||
|
||
|
||
//CAN发送一帧报文
|
||
public override void CanSendMessage(UInt32 id, byte[] data, int len)
|
||
{
|
||
TLIBCAN msg = new TLIBCAN(0, (int)id, true, false, false, MessagesLenToDlc(len), data);
|
||
|
||
if (TsMasterApi.tsapp_transmit_can_async(ref msg) == 0)
|
||
{
|
||
|
||
}
|
||
else
|
||
{
|
||
|
||
}
|
||
}
|
||
|
||
//CAN从FIFO接收一帧报文
|
||
public override bool CanReadMessage(ref UInt32 id, byte[] data, ref int len)
|
||
{
|
||
TLIBCAN msg;
|
||
bool ret = false;
|
||
|
||
if(true == TsMasterApi.tsfifo_receive_can_message(out msg, 0))
|
||
{
|
||
id = (UInt32)msg.FIdentifier;
|
||
msg.FData.CopyTo(data, 0);
|
||
len = MessagesDlcToLen(msg.FDLC);
|
||
|
||
ret = true;
|
||
}
|
||
|
||
return ret;
|
||
}
|
||
|
||
|
||
//CAN接收事件
|
||
private void OnCANRxEvent(IntPtr AObj, ref TLIBCAN AData)
|
||
{
|
||
if (AData.FIsTx)//发送的报文
|
||
{
|
||
|
||
}
|
||
else if(false == AData.FIsError)//接受的报文
|
||
{
|
||
TLIBCAN msg;
|
||
|
||
while(true == TsMasterApi.tsfifo_receive_can_message(out msg, 0))
|
||
{
|
||
CanReadEventInvoke((UInt32)AData.FIdentifier, AData.FData, MessagesDlcToLen(AData.FDLC));
|
||
}
|
||
|
||
}
|
||
}
|
||
|
||
#endregion
|
||
|
||
//CANFD
|
||
#region CANFD
|
||
|
||
//CANFD初始化
|
||
public override string CanFdInit()
|
||
{
|
||
TsMasterApi.initialize_lib_tsmaster(Name);
|
||
|
||
//创建通道数
|
||
if ((TsMasterApi.tsapp_set_can_channel_count(1) == 0)
|
||
&& (TsMasterApi.tsapp_set_lin_channel_count(0) == 0)
|
||
)
|
||
{
|
||
|
||
}
|
||
else
|
||
{
|
||
return "创建通道失败";
|
||
}
|
||
|
||
//创建通道映射
|
||
if (TsMasterApi.tsapp_set_mapping_verbose(Name, TLIBApplicationChannelType.APP_CAN,
|
||
APP_CHANNEL.CHN1, "TC1012", TLIBBusToolDeviceType.TS_USB_DEVICE, 12, 0, HARDWARE_CHANNEL.CHN1) == 0)
|
||
{
|
||
|
||
}
|
||
else
|
||
{
|
||
return "创建通道映射失败";
|
||
}
|
||
|
||
|
||
//初始化通道参数
|
||
#if true
|
||
|
||
if (TsMasterApi.tsapp_configure_baudrate_canfd((int)APP_CHANNEL.CHN1, 500, 2000, TLIBCANFDControllerType.lfdtISOFDCAN, TLIBCANFDControllerMode.lfdmNormal, true) == 0)
|
||
{
|
||
|
||
}
|
||
else
|
||
{
|
||
return "创建通道参数失败";
|
||
}
|
||
#else
|
||
if (TsMasterApi.tsapp_configure_canfd_regs(APP_CHANNEL.CHN1,
|
||
500, 4, 1, 1, 1, //500
|
||
2000, 4, 1, 1, 1, //2000
|
||
TLIBCANFDControllerType.lfdtISOFDCAN, TLIBCANFDControllerMode.lfdmNormal, 0) != 0)
|
||
{
|
||
return "创建通道参数失败";
|
||
}
|
||
#endif
|
||
|
||
|
||
//连接application：连接硬件通道并开启接收FIFO
|
||
int ret = TsMasterApi.tsapp_connect();
|
||
string connectResult = TsMasterApi.tsapp_get_error_description(ret);
|
||
if (0 == ret)
|
||
{
|
||
TsMasterApi.tsfifo_enable_receive_fifo();
|
||
}
|
||
else
|
||
{
|
||
return "连接设备失败";
|
||
}
|
||
|
||
TsMasterApi.tsapp_unregister_events_all((IntPtr)0);
|
||
|
||
|
||
return "OK";
|
||
}
|
||
|
||
|
||
//CANFD逆初始化
|
||
public override string CanFdDeInit()
|
||
{
|
||
base.CanFdDeInit();
|
||
|
||
TsMasterApi.tsapp_unregister_events_all((IntPtr)0);
|
||
|
||
if((0 == TsMasterApi.tsapp_disconnect())
|
||
)
|
||
{
|
||
return "OK";
|
||
}
|
||
else
|
||
{
|
||
return "断开连接失败";
|
||
}
|
||
|
||
}
|
||
|
||
public override string CanFdSetFilter(UInt32 stratId, UInt32 endId)
|
||
{
|
||
//清除所有过滤器
|
||
for (int i = 0; i < 0x7ff; i++)
|
||
{
|
||
TsMasterApi.tsfifo_delete_can_canfd_pass_filter(APP_CHANNEL.CHN1, (int)i);
|
||
}
|
||
|
||
//设置过滤
|
||
for (UInt32 i = stratId; i <= endId; i++)
|
||
{
|
||
TsMasterApi.tsfifo_add_can_canfd_pass_filter(APP_CHANNEL.CHN1, (int)i, true);
|
||
}
|
||
|
||
return "OK";
|
||
}
|
||
|
||
public override string CanFdReceiveEventEnable()
|
||
{
|
||
string ret;
|
||
|
||
//注册接收回调函数：在每一次的回调函数vCANQueueEventObj中刷新数据段
|
||
if (0 == TsMasterApi.tsapp_register_event_canfd((IntPtr)0, CanFdQueueEvent))
|
||
{
|
||
ret = "OK";
|
||
}
|
||
else
|
||
{
|
||
ret = "创建接受报文事件失败";
|
||
}
|
||
|
||
return ret;
|
||
}
|
||
|
||
|
||
public override string CanFdReceiveEventDisable()
|
||
{
|
||
return this.CanReceiveEventDisable();
|
||
}
|
||
|
||
//CANFD发送一帧报文
|
||
public override void CanFdSendMessage(UInt32 id, byte[] data, int len)
|
||
{
|
||
TLIBCANFD msg = new TLIBCANFD(APP_CHANNEL.CHN1, (int)id, true, false, false, MessagesLenToDlc(len), data, true, true);
|
||
|
||
if (TsMasterApi.tsapp_transmit_canfd_async(ref msg) == 0)
|
||
{
|
||
|
||
}
|
||
else
|
||
{
|
||
|
||
}
|
||
}
|
||
|
||
|
||
//CANFD从FIFO接收一帧报文
|
||
public override bool CanFdReadMessage(ref UInt32 id, byte[] data, ref int len)
|
||
{
|
||
TLIBCANFD msg = new TLIBCANFD();
|
||
bool ret = false;
|
||
|
||
if (true == TsMasterApi.tsfifo_receive_canfd_message(ref msg, 0))
|
||
{
|
||
id = (UInt32)msg.FIdentifier;
|
||
msg.FData.CopyTo(data, 0);
|
||
len = MessagesDlcToLen(msg.FDLC);
|
||
ret = true;
|
||
}
|
||
|
||
return ret;
|
||
}
|
||
|
||
|
||
//CANFD接收报文事件
|
||
private void OnCANFDRxEvent(IntPtr AObj, ref TLIBCANFD AData)
|
||
{
|
||
//发送的报文
|
||
if (AData.FIsTx)
|
||
{
|
||
|
||
}
|
||
else if (false == AData.FIsError)//接受的报文
|
||
{
|
||
TLIBCANFD msg = new TLIBCANFD();
|
||
|
||
while (true == TsMasterApi.tsfifo_receive_canfd_message(ref msg, 0))
|
||
{
|
||
CanReadEventInvoke((UInt32)AData.FIdentifier, AData.FData, MessagesDlcToLen(AData.FDLC));
|
||
}
|
||
}
|
||
}
|
||
|
||
|
||
#endregion
|
||
|
||
|
||
}
|
||
}
|