def clickMethod_dispLess(self):
"""Method to """
try:
MotorPI.move_rel(-self.step_disp)
except:
QMessageBox.about(self, "WARNING:", "The motor is not connected")
def clickMethod_disp0(self):
"""Method to """
msg = QMessageBox.question(self, "Come back to the base",
"Are u sure ?",
QMessageBox.Yes | QMessageBox.No,
QMessageBox.Yes)
if msg == QMessageBox.Yes:
try:
MotorPI.move_rel(-round((self.d - self.tare_disp), 2))
except:
QMessageBox.about(self, "WARNING:",
"The motor is not connected")
def LoadControl(self):
self.update_thread.emit()
while self.F == False:
time.sleep(0.1)
while self.F < self.dF_target * 0.9 or self.F > self.dF_target * 1.1:
self.update_thread.emit()
if self.F < self.dF_target * 0.9:
MotorPI.move_rel(0.2)
while MotorPI.ismoving():
time.sleep(0.1)
if self.F > self.dF_target * 1.1:
MotorPI.move_rel(-0.2)
while MotorPI.ismoving():
time.sleep(0.1)
self.update_thread.emit()
time.sleep(0.5)
def DisplacementControl(self):
#Cycles first
if self.NcycleF != 0:
cycle = 0
while cycle < self.NcycleF:
MotorPI.move_rel(self.dF_target)
while MotorPI.ismoving():
#print("motor running")
time.sleep(0.1)
if self.pause == True:
return
MotorPI.move_rel(-self.dF_target)
while MotorPI.ismoving():
time.sleep(0.1)
cycle = cycle + 1
if self.pause:
return
MotorPI.move_rel(self.dF_target)
while MotorPI.ismoving():
time.sleep(0.1)
def ini_processCall(self):
"""Function that initialise: start the motor to find upper and lower boundaries"""
#Button check not more than one time
if self.ini_start:
return
self.ini_start = True
#Define the progress bar
self.completed = 0
#######################################################
# Define the connections with devices
self.label.setText("Connecting...")
self.repaint()
time.sleep(1)
#######################################################
## CONNECTION WITH ARDUINO/PUMP/MOTOR
self.connectionCall()
msg = ""
if Arduino.isconnected():
msg += "Arduino: Connected\n"
else:
msg += "Arduino: Not connected\n"
if Pump_seringe.isconnected():
msg += "Pump: Connected\n"
else:
msg += "Pump: Not connected\n"
if MotorPI.isconnected():
msg += "Motor: Connected\n"
else:
msg += "Motor: Not connected\n"
QMessageBox.about(self, "Connections", msg)
if Arduino.isconnected() == False or MotorPI.isconnected(
) == False or Pump_seringe.isconnected() == False:
print('Connection problem')
self.ini_start = False
self.label.setText("Waiting")
return
secu = 0
test = 0
while test == 0:
try:
[secu, ori, F, P] = read_arduino()
test = 1
except:
print("read step1 problem")
if secu == 1:
QMessageBox.about(self, "Problem", "Security button activated !")
self.completed = 0
self.ini_start = False
self.timer_ini.stop()
return
msg = QMessageBox.question(
self, "Continue ?", "Do you want to start the initialisation ?",
QMessageBox.Yes | QMessageBox.No, QMessageBox.Yes)
if msg == QMessageBox.No:
self.ini_start = False
return
#######################################################
## SEARCH FOR BOUNDARIES
self.completed = 0
self.progress.setValue(self.completed)
self.label.setText("Searching for origin")
self.repaint()
#First boundary
try:
MotorPI.vel(55)
except:
QMessageBox.about(self, "Problem", "Retry please")
self.ini_start = False
self.timer_ini.stop()
MotorPI.disconnect()
return
MotorPI.ref()
try:
MotorPI.move_rel(50)
except:
QMessageBox.about(self, "Problem", "Retry please")
self.ini_start = False
self.timer_ini.stop()
return
while ori == 0:
if self.completed >= 100:
self.completed = 0
self.progress.setValue(self.completed)
time.sleep(0.1)
try:
[secu, ori, F, P] = read_arduino()
except:
print("read step1 problem")
self.completed = self.completed + 20
self.progress.setValue(self.completed)
time.sleep(0.5)
try:
[secu, ori, F, P] = read_arduino()
except:
print("read step1 problem")
if secu == 1:
QMessageBox.about(self, "Problem",
"Security button activated !")
self.completed = 0
self.ini_start = False
self.timer_ini.stop()
return
try:
MotorPI.stop()
except:
print("motor stop")
MotorPI.ref()
self.completed = 100
self.progress.setValue(self.completed)
# QMessageBox.about(self, "Origin", "The origin was found successfully")
time.sleep(1)
self.completed = 0
self.progress.setValue(self.completed)
self.label.setText("Returning mid")
self.repaint()
#Return
L_return = -50
MotorPI.move_rel(L_return)
deg = 360 * abs(L_return) / MotorPI.p
t = deg / MotorPI.vel_value()
debut = time.time()
limit = t / 99
while MotorPI.ismoving():
if time.time() - debut > limit:
self.completed = self.completed + 1
self.progress.setValue(self.completed)
limit = limit + t / 99
try:
[secu, ori, F, P] = read_arduino()
except:
print("read step1 problem")
if secu == 1:
QMessageBox.about(self, "Problem",
"Security button activated !")
self.ini_start = False
self.timer_ini.stop()
return
self.completed = 100
self.progress.setValue(self.completed)
self.label.setText("Finish")
MotorPI.vel(20)
self.timer_ini.stop()
QMessageBox.about(
self, "Acquisition",
"Initialisation finished\n\nStart of the acquisition")
self.switch_window.emit(self.path)
self.close()
def update_window(self):
"""Method called each time the timer clocks"""
self.connectionCall(
) #Method to check the connection of the devices (method in "Left_panel")
try:
#[self.secu,self.ori,self.F,self.P] = read() #Method to save current value of load and pressure
self.ReadThread.start()
except:
print("ReadThread pb")
self.vol = 0
#
try:
self.d = MotorPI.motor_pos()
if self.d < -50.1:
self.clickMethodStop()
MotorPI.move_rel(1)
QMessageBox.about(self, "Warning",
"The end course was reached")
self.label_disp_abs_display.setText(
"Abs: " + str(round(self.d, 2)) + " mm") #Display the value
self.label_disp_rel_display.setText(
str(round(
(self.d - self.tare_disp), 2)) + " mm") #Display the value
except:
print("Problem MotorPI.motor_pos() in update()")
self.label_pressure_display.setText(
f"{self.P:.3f} mmHg") #Display the value
#self.label_volume_display.setText(str(round(self.vol,4)) + " ml") #Display the value
self.label_load_display.setText(f"{self.F:.3f} N") #Display the value
if self.secu == 1:
self.clickMethodStop()
msg = QMessageBox.question(
self, "Arret d'urgence ou Fin de course !",
"Did you push the emergency stop button ?",
QMessageBox.Yes | QMessageBox.No, QMessageBox.Yes)
if msg == QMessageBox.No:
QMessageBox.about(
self, "Warning",
"The end course was activated, you have to move the motor manually and restart the initialisation"
)
self.timer.stop()
self.return_window.emit()
else:
try:
[self.secu, self.ori, self.F, self.P] = read(
) #Method to save current value of load and pressure
except:
print("Read problem")
while self.secu == 1:
QMessageBox.about(self, "Warning",
"Un-push the emergency stop button")
try:
[self.secu, self.ori, self.F, self.P] = read(
) #Method to save current value of load and pressure
except:
pass
MotorPI.connect()
return
#------------------------------------------------------------------
## This part is activate when the user start the machanical test
#------------------------------------------------------------------
if not self.running:
return
self.time_now = time.time(
) - self.time_ini_graph #Save the timepassed since the starting time
#####################
#Graphic update
if not self.time_now or self.F or self.P: #If value are null don't show on graph (because at the beginning values null)
#xv = np.array([self.time_now])
self.array_F.append(float(self.F))
self.array_P.append(float(self.P))
self.array_d.append(float(self.d - self.tare_disp))
self.array_t.append(float(self.time_now))
if self.Lxaxis == "Displacement (mm)":
Lx = self.array_d
elif self.Lxaxis == "Force (N)":
Lx = self.array_F
elif self.Lxaxis == "Pressure (mmHg)":
Lx = self.array_P
elif self.Lxaxis == "Time (s)":
Lx = self.array_t
if self.Lyaxis == "Displacement (mm)":
Ly = self.array_d
elif self.Lyaxis == "Force (N)":
Ly = self.array_F
elif self.Lyaxis == "Pressure (mmHg)":
Ly = self.array_P
elif self.Lyaxis == "Time (s)":
Ly = self.array_t
if self.Rxaxis == "Displacement (mm)":
Rx = self.array_d
elif self.Rxaxis == "Force (N)":
Rx = self.array_F
elif self.Rxaxis == "Pressure (mmHg)":
Rx = self.array_P
elif self.Rxaxis == "Time (s)":
Rx = self.array_t
if self.Ryaxis == "Displacement (mm)":
Ry = self.array_d
elif self.Ryaxis == "Force (N)":
Ry = self.array_F
elif self.Ryaxis == "Pressure (mmHg)":
Ry = self.array_P
elif self.Ryaxis == "Time (s)":
Ry = self.array_t
self.graphL.setData(Lx, Ly) #Show on the graph
self.graphR.setData(Rx, Ry) #Show on the graph
#####################
# Result file update
with open(self.path + '/' + self.file_save + '.txt',
'a') as mon_fichier:
mon_fichier.write(
str(round(time.time() - self.time_ini, 2)) + " , " +
str(round(self.d - self.tare_disp, 3)) + " , " + str(self.F) +
" , " + str(self.P) + " , " + str(self.vol) + "\n")