62 lines
2.1 KiB
Python
62 lines
2.1 KiB
Python
|
import time
|
|||
|
|
from hardware.relay import RelayController
|
|||
|
|
from hardware.transmitter import TransmitterController
|
|||
|
|
from test_feed import start_feeding
|
|||
|
|
|
|||
|
|
def start_feeding():
|
|||
|
|
"""第一阶段下料：下料斗向模具车下料（低速）"""
|
|||
|
|
print("开始下料")
|
|||
|
|
# self.relay_controller.control
|
|||
|
|
loc_relay=RelayController()
|
|||
|
|
loc_mitter=TransmitterController(loc_relay)
|
|||
|
|
initial_lower_weight=loc_mitter.read_data(2)
|
|||
|
|
initial_upper_weight=loc_mitter.read_data(1)
|
|||
|
|
first_finish_weight=0
|
|||
|
|
start_time=None
|
|||
|
|
# mould_need_weight=4000
|
|||
|
|
while True:
|
|||
|
|
current_weight = loc_mitter.read_data(2)
|
|||
|
|
first_finish_weight=initial_lower_weight-current_weight
|
|||
|
|
if current_weight<500:
|
|||
|
|
#关5秒
|
|||
|
|
if start_time is None or time.time()-start_time>5:
|
|||
|
|
start_time=time.time()
|
|||
|
|
loc_relay.control_arch_lower_open()
|
|||
|
|
|
|||
|
|
if current_weight<100:
|
|||
|
|
start_time=None
|
|||
|
|
loc_relay.control_lower_close()
|
|||
|
|
break
|
|||
|
|
print(f'------------已下料: {first_finish_weight}kg-------------')
|
|||
|
|
time.sleep(1)
|
|||
|
|
|
|||
|
|
#打开上料斗出砼门，开5就，开三分之一下
|
|||
|
|
loc_relay.control_upper_open_sync(5)
|
|||
|
|
while True:
|
|||
|
|
current_upper_weight = loc_mitter.read_data(1)
|
|||
|
|
if current_upper_weight<3500:
|
|||
|
|
#关5秒
|
|||
|
|
loc_relay.control_upper_close()
|
|||
|
|
break
|
|||
|
|
time.sleep(1)
|
|||
|
|
|
|||
|
|
initial_lower_weight=loc_mitter.read_data(2)
|
|||
|
|
while True:
|
|||
|
|
current_weight = loc_mitter.read_data(2)
|
|||
|
|
first_finish_weight=first_finish_weight+initial_lower_weight-current_weight
|
|||
|
|
if current_weight<500:
|
|||
|
|
#关5秒
|
|||
|
|
if start_time is None or time.time()-start_time>5:
|
|||
|
|
start_time=time.time()
|
|||
|
|
loc_relay.control_arch_lower_open()
|
|||
|
|
if current_weight<100:
|
|||
|
|
start_time=None
|
|||
|
|
loc_relay.control_lower_close()
|
|||
|
|
break
|
|||
|
|
print(f'------------已下料: {first_finish_weight}kg-------------')
|
|||
|
|
time.sleep(1)
|
|||
|
|
|
|||
|
|
if __name__ == "__main__":
|
|||
|
|
start_feeding()
|
|||
|
|
|
|||
|
|
|