update 完成控制基本逻辑

This commit is contained in:
FrankCV2048
2024-12-03 23:25:17 +08:00
parent 157e7edce5
commit aa93685862
8 changed files with 728 additions and 262 deletions

View File

@ -1,6 +1,7 @@
import configparser
import Constant
from CU.Feeding import LineType
from Model.Position import Real_Position
@ -49,6 +50,7 @@ class PositionModel:
self.order = 0
self.lineId = 0
self.status = 0
self.lineType = 0
self.section = f'Position{index}'
pass
@ -64,12 +66,28 @@ class PositionModel:
self.order = config_reader.getint(self.section, 'order')
self.lineId = config_reader.getint(self.section, 'lineId')
self.status = config_reader.getint(self.section, 'status')
self.lineType = config_reader.getint(self.section, 'lineType')
def get_position(self):
real_pos = Real_Position()
real_pos.init_position(self.X, self.Y, self.Z, self.U, self.V, self.W)
if real_pos.X == -9999:
return None
return real_pos
def set_position(self,real_pos:Real_Position):
if real_pos == None:
self.X = -9999
self.Y = -9999
self.Z = -9999
self.U = -9999
self.V = -9999
self.W = -9999
return
self.X = real_pos.X
self.Y = real_pos.Y
self.Z = real_pos.Z
self.U = real_pos.U
self.V = real_pos.V
self.W = real_pos.W
def save_position_model(self,config_reader):
if not config_reader.has_section(self.section):
config_reader.add_section(self.section)
@ -83,3 +101,4 @@ class PositionModel:
config_reader.set(self.section, 'order', str(self.order))
config_reader.set(self.section, 'lineId', str(self.lineId))
config_reader.set(self.section, 'status', str(self.status))
config_reader.set(self.section, 'lineType', str(self.lineType))