首次上传

This commit is contained in:
hanqiangqiang
2026-06-15 10:56:30 +08:00
commit b0213b94d6
4160 changed files with 736101 additions and 0 deletions
@@ -0,0 +1,345 @@
using System;
using System.Text.RegularExpressions;
using System.Threading;
using Aitex.Core.RT.Log;
using Aitex.Core.Util;
using MECF.Framework.Simulator.Core.Driver;
namespace MECF.Framework.Simulator.Core.Robots.HAtm
{
public class HAtmRobotSimulator : SocketDeviceSimulator
{
protected Random _rd = new Random();
public bool IsError { get; set; }
public bool IsBusy { get; set; }
public bool IsWaferPresent { get; set; }
public string ResultValue { get; set; }
private const string EOT = "\n";
private int _targetThetaAxisAddressPosition;
private int _targetZAxisAddressPosition;
private DeviceTimer _devicetimer = new DeviceTimer();
private DeviceTimer _waferTimer = new DeviceTimer();
private DeviceTimer _homeTimer = new DeviceTimer();
private int _waferPresentTime = 3700;
private int _moveTime = 5000;
private bool _isAllCommandsHaveResponse;
private bool _isUp;
public HAtmRobotSimulator(int port = 9002)
:base(port, 1, "\r", ',')
{
//Action Command
AddCommandHandler("HM", HandleMHOM);
AddCommandHandler("D", HandleAbort);
AddCommandHandler("ER", HandleError);
AddCommandHandler("PK", HandlePick);
AddCommandHandler("PL", HandlePlace);
AddCommandHandler("GO", HandleGo);
AddCommandHandler("GZ", HandleGz);
AddCommandHandler("AA", HandleQueryAllAxisStatus);
AddCommandHandler("TA", HandleQueryThetaAxisStatus);
AddCommandHandler("ZA", HandleQueryZAxisStatus);
AddCommandHandler("RA", HandleQueryRadialAxisStatus);
AddCommandHandler("OS", HandleQueryOperationalStatus);
AddCommandHandler("GP", HandleQueryPosition);
AddCommandHandler("RR", HandleSetCommandResponse);
AddCommandHandler("VN", HandleVacuumOff);
AddCommandHandler("VY", HandleVacuumOn);
AddCommandHandler("MH", HandleSetSpeed);
AddCommandHandler("MP", HandleWaferMap);
AddCommandHandler("Unknown", HandleUnknown);
}
public void HandleAbort(string obj)
{
}
public void HandleError(string obj)
{
string[] datas = Regex.Split(obj.Replace("\r", "").Replace("\n", ""), ",");
string ack = string.Format($"X,ER,OK{EOT}");
if (datas.Length >= 2 && datas[0] == "R")
{
if (IsError)
{
ack = string.Format("X,ER,{0},{1},{2},{3}{4}",
"A0",
"A1",
"A2",
"A3",
EOT);
}
}
OnWriteMessage(ack);
}
public void HandlePick(string obj)
{
string[] datas = Regex.Split(obj.Replace("\r", "").Replace("\n", ""), ",");
if(datas.Length >=4)
{
int.TryParse(datas[2], out _targetThetaAxisAddressPosition);
int.TryParse(datas[3], out _targetZAxisAddressPosition);
}
IsWaferPresent = false;
IsBusy = true;
if (!_devicetimer.IsIdle())
_devicetimer.Stop();
_devicetimer.Start(0);
if (!_waferTimer.IsIdle())
_waferTimer.Stop();
_waferTimer.Start(0);
if(_isAllCommandsHaveResponse)
OnWriteMessage($"X,PK{EOT}");
}
public void HandlePlace(string obj)
{
string[] datas = Regex.Split(obj.Replace("\r", "").Replace("\n", ""), ",");
if (datas.Length >= 4)
{
int.TryParse(datas[2], out _targetThetaAxisAddressPosition);
int.TryParse(datas[3], out _targetZAxisAddressPosition);
}
IsWaferPresent = true;
IsBusy = true;
if (!_devicetimer.IsIdle())
_devicetimer.Stop();
_devicetimer.Start(0);
if (!_waferTimer.IsIdle())
_waferTimer.Stop();
_waferTimer.Start(0);
if (_isAllCommandsHaveResponse)
OnWriteMessage($"X,PL{EOT}");
}
public void HandleGz(string obj)
{
if (obj.Contains("U"))
_isUp = true;
else
_isUp = false;
IsBusy = true;
_devicetimer.Start(0);
if (_isAllCommandsHaveResponse)
OnWriteMessage($"X,GZ{EOT}");
}
public void HandleGo(string obj)
{
string[] datas = Regex.Split(obj.Replace("\r", "").Replace("\n", ""), ",");
if (datas.Length >= 5)
{
var data4 = datas[4].Replace("U", "").Replace("D", "");
int.TryParse(datas[3], out _targetThetaAxisAddressPosition);
int.TryParse(data4, out _targetZAxisAddressPosition);
}
IsBusy = true;
_devicetimer.Start(0);
if (_isAllCommandsHaveResponse)
OnWriteMessage($"X,GO{EOT}");
}
public void HandleQueryAllAxisStatus(string obj)
{
Thread.Sleep(200);
string ack = string.Format("X,AA,{0}{1:D2}{2:D2}{3}{4}",
"RE",
_targetThetaAxisAddressPosition,
_targetZAxisAddressPosition,
_isUp ? "U" : "D",
EOT);
OnWriteMessage(ack);
}
public void HandleQueryRadialAxisStatus(string obj)
{
Thread.Sleep(200);
string ack = string.Format("X,RA,{0}{1}{2}{3}{4}{5}",
IsBusy ? "B" : "R",
"R",
"RE",
"RE",
" ",
EOT);
OnWriteMessage(ack);
}
public void HandleQueryThetaAxisStatus(string obj)
{
Thread.Sleep(200);
string ack = string.Format("X,TA,{0}{1}{2:D2}{3}{4}{5}",
IsBusy ? "B" : "R",
"R",
_targetThetaAxisAddressPosition,
" ",
" ",
EOT);
OnWriteMessage(ack);
}
public void HandleQueryZAxisStatus(string obj)
{
Thread.Sleep(200);
string ack = string.Format("X,ZA,{0}{1}{2:D2}{3}{4}{5}{6}{7}",
IsBusy ? "B" : "R",
"R",
_targetZAxisAddressPosition,
_isUp ? "U" : "D",
" ",
"U",
" ",
EOT);
OnWriteMessage(ack);
}
public void HandleQueryOperationalStatus(string obj)
{
if (!_waferTimer.IsIdle())
{
if (_waferTimer.GetElapseTime() > _waferPresentTime)
{
IsWaferPresent = !IsWaferPresent;
_waferTimer.Stop();
LOG.Info("simulator receive os change Wafer present");
}
}
if (!_devicetimer.IsIdle())
{
if (_devicetimer.GetElapseTime() > _moveTime)
{
_devicetimer.Stop();
IsBusy = false;
LOG.Info("simulator receive os change busy");
}
}
if(!_homeTimer.IsIdle() && _homeTimer.GetElapseTime() > _moveTime)
{
IsBusy = false;
_homeTimer.Stop();
}
Thread.Sleep(200);
string ack = string.Format("X,OS,{0}{1}{2}{3}{4}{5:D2}{6:D2}{7}{8}{9}{10}{11}{12}",
IsError ? "E" : " ",
IsBusy ? "B" : " ",
"R",
"V",
"AA",
_targetThetaAxisAddressPosition,
_targetZAxisAddressPosition,
"S",
IsWaferPresent ? "Y" : "N",
"J",
" ",
"L",
EOT);
OnWriteMessage(ack);
}
public void HandleQueryPosition(string obj)
{
Thread.Sleep(20);
if (!_homeTimer.IsIdle() && _homeTimer.GetElapseTime() > 2000)
{
string ack = string.Format("X,GP,{0},{1},{2},{3},{4},{5}{6}",
0.ToString(),
11118.ToString(),
0.ToString(),
0.ToString(),
11118.ToString(),
1149.ToString(),
EOT);
OnWriteMessage(ack);
}
else
{
string ack = string.Format("X,GP,{0},{1},{2},{3},{4},{5}{6}",
0.ToString(),
11118.ToString(),
1149.ToString(),
0.ToString(),
11118.ToString(),
1149.ToString(),
EOT);
OnWriteMessage(ack);
}
}
public virtual void HandleUnknown(string obj)
{
}
public virtual void HandleMHOM(string msg)
{
_targetThetaAxisAddressPosition = 0;
IsBusy = true;
_homeTimer.Start(0);
if (_isAllCommandsHaveResponse)
OnWriteMessage($"X,HM{EOT}");
}
public void HandleSetCommandResponse(string msg)
{
OnWriteMessage($"X,RR{EOT}");
_isAllCommandsHaveResponse = true;
}
public void HandleSetSpeed(string msg)
{
if (_isAllCommandsHaveResponse)
OnWriteMessage($"X,MH{EOT}");
}
public void HandleVacuumOn(string msg)
{
if (_isAllCommandsHaveResponse)
OnWriteMessage($"X,VY{EOT}");
}
public void HandleVacuumOff(string msg)
{
if (_isAllCommandsHaveResponse)
OnWriteMessage($"X,VN{EOT}");
}
public void HandleWaferMap(string msg)
{
string[] datas = Regex.Split(msg.Replace("\r", "").Replace("\n", ""), ",");
int _targetThetaAxisAddressPosition = 0;
if (datas.Length >= 3)
{
int.TryParse(datas[2], out _targetThetaAxisAddressPosition);
}
if (msg.Contains("A"))
{
if (_isAllCommandsHaveResponse)
OnWriteMessage($"X,MP,{_targetThetaAxisAddressPosition.ToString("D2")}{EOT}");
}
else
{
OnWriteMessage($"X,MP,{_targetThetaAxisAddressPosition.ToString("D2")},1111111111111111111111111{EOT}");
}
}
}
}
@@ -0,0 +1,70 @@
<UserControl x:Class="MECF.Framework.Simulator.Core.Robots.HAtm.HAtmRobotView"
xmlns="http://schemas.microsoft.com/winfx/2006/xaml/presentation"
xmlns:x="http://schemas.microsoft.com/winfx/2006/xaml"
xmlns:mc="http://schemas.openxmlformats.org/markup-compatibility/2006"
xmlns:d="http://schemas.microsoft.com/expression/blend/2008"
xmlns:local="clr-namespace:MECF.Framework.Simulator.Core.Aligners"
xmlns:deviceControl="clr-namespace:MECF.Framework.UI.Core.DeviceControl;assembly=MECF.Framework.UI.Core"
xmlns:commons="clr-namespace:MECF.Framework.Simulator.Core.Commons"
Height="900" Width="900">
<Grid>
<Grid.RowDefinitions>
<RowDefinition Height="100"></RowDefinition>
<RowDefinition Height="150"></RowDefinition>
<RowDefinition Height="50"></RowDefinition>
<RowDefinition Height="400"></RowDefinition>
</Grid.RowDefinitions>
<commons:SocketTitleView Grid.Row="0"></commons:SocketTitleView>
<Canvas Grid.Row="1" Width="900">
<CheckBox Content="Error" IsChecked="{Binding IsError}" Checked="ErrorCheckBox_Checked" Unchecked="ErrorCheckBox_Checked" Canvas.Left="36" Canvas.Top="30"/>
<CheckBox Content="Busy" IsChecked="{Binding IsBusy}" Checked="BusyCheckBox_Checked" Unchecked="BusyCheckBox_Checked" Canvas.Left="36" Canvas.Top="60"/>
<CheckBox Content="Wafer Present" IsChecked="{Binding IsWaferPresent}" Checked="WaferPresentCheckBox_Checked" Unchecked="WaferPresentCheckBox_Checked" Canvas.Left="36" Canvas.Top="90"/>
</Canvas>
<StackPanel Grid.Row="2" Orientation="Horizontal" Width="900">
<Button Content="Clear Log" Width="100" Height="35" Command="{Binding ClearLogCommand}"></Button>
</StackPanel>
<DataGrid Grid.Row="3" FontSize="16" AutoGenerateColumns="False" CanUserAddRows="False" CanUserResizeRows="False" CanUserSortColumns="False" ItemsSource="{Binding TransactionLogItems}"
ScrollViewer.CanContentScroll="True"
ScrollViewer.VerticalScrollBarVisibility="Auto"
ScrollViewer.HorizontalScrollBarVisibility="Auto"
Width="900" Height="380" VerticalAlignment="Top">
<DataGrid.Columns>
<DataGridTextColumn Header="Time" Width="160" IsReadOnly="True" Binding="{Binding OccurTime, UpdateSourceTrigger=PropertyChanged}"/>
<DataGridTextColumn Header="Incoming" Width="350" IsReadOnly="True" Binding="{Binding Incoming, UpdateSourceTrigger=PropertyChanged}">
<DataGridTextColumn.ElementStyle>
<Style TargetType="TextBlock">
<Setter Property="TextWrapping" Value="Wrap"/>
<Setter Property="Height" Value="auto"/>
</Style>
</DataGridTextColumn.ElementStyle>
</DataGridTextColumn>
<DataGridTextColumn Header="Outgoing" Width="350" IsReadOnly="True" Binding="{Binding Outgoing, UpdateSourceTrigger=PropertyChanged}">
<DataGridTextColumn.ElementStyle>
<Style TargetType="TextBlock">
<Setter Property="TextWrapping" Value="Wrap"/>
<Setter Property="Height" Value="auto"/>
</Style>
</DataGridTextColumn.ElementStyle>
</DataGridTextColumn>
</DataGrid.Columns>
</DataGrid>
</Grid>
</UserControl>
@@ -0,0 +1,99 @@
using System;
using System.Collections.Generic;
using System.Collections.ObjectModel;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
using System.Windows;
using System.Windows.Controls;
using System.Windows.Data;
using System.Windows.Documents;
using System.Windows.Input;
using System.Windows.Media;
using System.Windows.Media.Imaging;
using System.Windows.Navigation;
using System.Windows.Shapes;
using Aitex.Core.UI.MVVM;
using Aitex.Core.Utilities;
using MECF.Framework.Simulator.Core.Aligners;
using MECF.Framework.Simulator.Core.Commons;
using MECF.Framework.Simulator.Core.Driver;
namespace MECF.Framework.Simulator.Core.Robots.HAtm
{
/// <summary>
/// HAtmRobotView.xaml 的交互逻辑
/// </summary>
public partial class HAtmRobotView : UserControl
{
public HAtmRobotView()
{
InitializeComponent();
this.DataContext = new HAtmRobotViewModel();
this.Loaded += OnViewLoaded;
}
private void OnViewLoaded(object sender, RoutedEventArgs e)
{
(DataContext as TimerViewModelBase).Start();
}
private void ErrorCheckBox_Checked(object sender, RoutedEventArgs e)
{
var viewmodel = DataContext as HAtmRobotViewModel;
if (viewmodel != null)
viewmodel.SetError();
}
private void BusyCheckBox_Checked(object sender, RoutedEventArgs e)
{
var viewmodel = DataContext as HAtmRobotViewModel;
if (viewmodel != null)
viewmodel.SetBusy();
}
private void WaferPresentCheckBox_Checked(object sender, RoutedEventArgs e)
{
var viewmodel = DataContext as HAtmRobotViewModel;
if (viewmodel != null)
viewmodel.SetWaferPresent();
}
}
class HAtmRobotViewModel : SocketDeviceViewModel
{
public string Title
{
get { return "HAtm Robot Simulator"; }
}
private HAtmRobotSimulator _robot;
public bool IsError { get; set; }
public bool IsBusy { get; set; }
public bool IsWaferPresent { get; set; }
public void SetError()
{
_robot.IsError = IsError;
}
public void SetBusy()
{
_robot.IsBusy = IsBusy;
}
public void SetWaferPresent()
{
_robot.IsWaferPresent = IsWaferPresent;
}
public HAtmRobotViewModel() : base("HAtmRobotViewModel")
{
_robot = new HAtmRobotSimulator();
Init(_robot);
}
}
}