Compare commits

..

No commits in common. "main" and "v0.0.21" have entirely different histories.

5 changed files with 122 additions and 356 deletions

Binary file not shown.

View File

@ -1,49 +1,33 @@
{
"device": {
"enter": {
"action": "Off"
},
"main": {
"action": "Off",
"duration": 4
},
"measure": {
"action": "On"
},
"mixed": {
"action": "Off"
},
"motor": {
"action": "Off"
},
"pure": {
"action": "Off",
"duration": 4
},
"setzero": {
"action": "Off"
},
"measure": {
"action": "On",
"duration": 20
},
"mixed": {
"action": "Off",
"duration": 7
},
"pure": {
"action": "Off",
"duration": 10,
"holding": 5
},
"enter":{
"action": "Off",
"duration": 10
},
"vent": {
"action": "Off",
"duration": 30,
"holding": 2
},
"motor": {
"action": "Off"
}
},
"maintenance": {
"clean": {
"duration": 20,
"time": 25
}
},
"type": "manual",
"working-time": {
"step0": 5,
"step1": 10,
"step2": 0.5,
"step3": 4,
"step4": 20,
"step5": 20,
"step6": 0.5,
"step7": 15,
"step8": 10,
"step9": 140
}
}
"type": "manual"
}

View File

@ -1,11 +1,11 @@
version: bwc/v2 # bwc 버전 정보입니다.
spec:
appName: sampyo-dio-app # 앱의 이름입니다.
runFile: main.py # 앱의 실행 파일입니다.
env:
bin: python3 # 앱을 실행할 바이너라 파일 종류입니다.(장비에 따라 다르므로 확인 후 정의해야 합니다.)
virtualEnv: base # 사용할 가상환경 이름입니다.
package: requirements.txt # 설치할 Python 패키지 정보 파일입니다.(기본 값은 requirement.txt 입니다.)
stackbase:
tagName: v0.0.51 # Stackbase(gitea)에 릴리즈 태그명 입니다.
repoName: sampyo-dio # Stackbase(gitea)에 저장될 저장소 이릅니다.
version: bwc/v2 # bwc 버전 정보입니다.
spec:
appName: sampyo-dio-app # 앱의 이름입니다.
runFile: main.py # 앱의 실행 파일입니다.
env:
bin: python3 # 앱을 실행할 바이너라 파일 종류입니다.(장비에 따라 다르므로 확인 후 정의해야 합니다.)
virtualEnv: base # 사용할 가상환경 이름입니다.
package: requirements.txt # 설치할 Python 패키지 정보 파일입니다.(기본 값은 requirement.txt 입니다.)
stackbase:
tagName: v0.0.21 # Stackbase(gitea)에 릴리즈 태그명 입니다.
repoName: sampyo-dio # Stackbase(gitea)에 저장될 저장소 이릅니다.

392
main.py
View File

@ -1,5 +1,6 @@
import json
import time
import argparse
import sys, signal
import gpiod
from pymodbus.client import ModbusTcpClient
@ -9,8 +10,6 @@ import pytz
from datetime import datetime
import threading, socket
import uuid
import logging
from logging.handlers import RotatingFileHandler
def Motor(chip, status, action):
if action == 'On':
@ -36,101 +35,15 @@ def Valve_MixedWater(chip, status, action):
chip.set_values(status)
def Valve_PureWater(chip, status, action, duration=7):
global pure_valve_status
status[2] = 0
status[3] = 0
chip.set_values(status)
time.sleep(0.05)
if pure_valve_status != 0 and action == 'Off':
status[2] = 0
def Valve_PureWater(chip, status, action):
if action == 'On':
status[3] = 1
chip.set_values(status)
time.sleep(7)
pure_valve_status = 0
elif pure_valve_status == 0 and action == 'On':
status[2] = 1
else: # action == 'Off'
status[3] = 0
chip.set_values(status)
time.sleep(duration)
if duration >= 7:
pure_valve_status = 2
elif duration < 7:
pure_valve_status = 1
status[2] = 0
status[3] = 0
chip.set_values(status)
time.sleep(0.05)
# def Valve_EnterWater(chip, status, action):
def Valve_EnterWater(chip, status, action, duration=7):
# if action == 'On':
# status[4] = 1
# else: # action == 'Off'
# status[4] = 0
# chip.set_values(status)
global main_valve_status
status[5] = 0
status[6] = 0
chip.set_values(status)
time.sleep(0.05)
if main_valve_status != 0 and action == 'Off':
status[5] = 0
status[6] = 1
chip.set_values(status)
time.sleep(7)
main_valve_status = 0
elif main_valve_status == 0 and action == 'On':
status[5] = 1
status[6] = 0
chip.set_values(status)
time.sleep(duration)
if duration >= 7:
main_valve_status = 2
elif duration < 7:
main_valve_status = 1
status[5] = 0
status[6] = 0
chip.set_values(status)
time.sleep(0.05)
# def Valve_MainWater(chip, status, action, duration=7):
def Valve_MainWater(chip, status, action):
global main_valve_status
# status[5] = 0
# status[6] = 0
# chip.set_values(status)
# time.sleep(0.05)
# if main_valve_status != 0 and action == 'Off':
# status[5] = 0
# status[6] = 1
# chip.set_values(status)
# time.sleep(7)
# main_valve_status = 0
# elif main_valve_status == 0 and action == 'On':
# status[5] = 1
# status[6] = 0
# chip.set_values(status)
# time.sleep(duration)
# if duration >= 7:
# main_valve_status = 2
# elif duration < 7:
# main_valve_status = 1
# status[5] = 0
# status[6] = 0
# chip.set_values(status)
# time.sleep(0.05)
def Valve_EnterWater(chip, status, action):
if action == 'On':
status[4] = 1
else: # action == 'Off'
@ -143,18 +56,17 @@ def Measure_Weight(client):
val = 0
try:
result = client.read_holding_registers(1, 1)
if not result:
if result.iserror():
print(f'Error: {result}')
else:
val = result.registers[0]
val -= 1000
val /= 1000
# print(f'value: {val}')
#print(f'value: {val}')
except Exception as e:
print(f'Measure_Weight Error: {e}')
pass
return float(val)
return flaot(val)
def Calculate_Concentration(weight):
global data, volume_water
@ -162,144 +74,114 @@ def Calculate_Concentration(weight):
result = (float(weight) * volume_water * 128.5) - 126.11 # 1000 / 531 = 1.883239171
data['data']['concentration'] = result
# print(f'{weight}, {result}')
return result
def Set_Zero(client):
client.write_coil(1, 1)
def Command_Read():
global client, main_valve_status, logger
with open('./control.json', 'r') as f:
cmd = json.load(f)
if cmd['type'] == 'auto':
main_duration = float(cmd['device']['main']['duration'])
pure_duration = float(cmd['device']['pure']['duration'])
step0_duration = float(cmd['working-time']['step0'])
step1_duration = float(cmd['working-time']['step1'])
step2_duration = float(cmd['working-time']['step2'])
step3_duration = float(cmd['working-time']['step3'])
step4_duration = float(cmd['working-time']['step4'])
step5_duration = float(cmd['working-time']['step5'])
step6_duration = float(cmd['working-time']['step6'])
step7_duration = float(cmd['working-time']['step7'])
step8_duration = float(cmd['working-time']['step8'])
step9_duration = float(cmd['working-time']['step9'])
Valve_Vent(chip=output_lines, status=status, action='Off')
Motor(chip=output_lines, status=status, action='Off')
# Step 0. Mesure init weight before starting the sequence
time.sleep(step0_duration)
start = Measure_Weight(client=client)
mixed_duration = int(cmd['device']['mixed']['duration'])
pure_duration = int(cmd['device']['pure']['duration'])
pure_holding = int(cmd['device']['pure']['holding'])
vent_duration = int(cmd['device']['vent']['duration'])
vent_holding = int(cmd['device']['vent']['holding'])
measure_duration = int(cmd['device']['measure']['duration'])
enter_duration = int(cmd['device']['enter']['duration'])
time.sleep(7)
start = Measure_Weight(client=client)
time.sleep(5)
# Step 1. Vent pured water before input mixed water
# Target valve status: [Motor: Off, Vent: On, Pure: Off, Enter: On, Main: On]
# Valve_EnterWater(chip=output_lines, status=status, action='On')
Valve_MainWater(chip=output_lines, status=status, action='On')
# input mixed water
Valve_MixedWater(chip=output_lines, status=status, action='On')
time.sleep(0.5)
Valve_EnterWater(chip=output_lines, status=status, action='On')
time.sleep(0.5)
Valve_Vent(chip=output_lines, status=status, action='On')
time.sleep(0.5)
# Valve_MainWater(chip=output_lines, status=status, action='On', duration=main_duration)
Valve_EnterWater(chip=output_lines, status=status, action='On', duration=main_duration)
time.sleep(step1_duration)
# Step 2. Empty the remaining pure water
# Target valve status: [Motor: Off, Vent: On, Pure: Off, Enter: Off, Main: On]
Valve_EnterWater(chip=output_lines, status=status, action='Off')
time.sleep(step2_duration)
# Step 3. Input the mixed water
# Target valve status: [Motor: Off, Vent: Off, Pure: Off, Enter: On, Main: On]
time.sleep(vent_holding)
Valve_Vent(chip=output_lines, status=status, action='Off')
time.sleep(0.5)
# Valve_EnterWater(chip=output_lines, status=status, action='On')
Valve_EnterWater(chip=output_lines, status=status, action='On', duration=main_duration)
time.sleep(step3_duration)
# Step 4. Mesure the weight
# Target valve status: [Motor: Off, Vent: Off, Pure: Off, Enter: Off, Main: Off]
Valve_MainWater(chip=output_lines, status=status, action='Off')
time.sleep(mixed_duration)
Valve_MixedWater(chip=output_lines, status=status, action='Off')
time.sleep(0.5)
Valve_EnterWater(chip=output_lines, status=status, action='Off')
time.sleep(step4_duration)
time.sleep(measure_duration)
# measure weight
end = Measure_Weight(client=client)
time.sleep(1)
res = Calculate_Concentration(weight=(float(end)-float(start)))
logger.debug(f'[auto] weight: {end - start} concentration: {res:.3f}')
Calculate_Concentration(weight=(float(end)-float(start)))
# Step 5. Drain the mixed water and add pure water.
# Target valve status: [Motor: Off, Vent: On, Pure: On, Enter: On, Main: Off]
Valve_Vent(chip=output_lines, status=status, action='On')
# # vent mixed water
# Valve_Vent(chip=output_lines, status=status, action='On')
# time.sleep(0.5)
# Motor(chip=output_lines, status=status, action='On')
# time.sleep(vent_duration)
# Motor(chip=output_lines, status=status, action='Off')
# time.sleep(0.5)
# Valve_Vent(chip=output_lines, status=status, action='Off')
# time.sleep(0.5)
# # input pure water
# Valve_PureWater(chip=output_lines, status=status, action='On')
# time.sleep(pure_duration)
# Valve_PureWater(chip=output_lines, status=status, action='Off')
# time.sleep(0.5)
# # vent pure water
# Valve_Vent(chip=output_lines, status=status, action='On')
# time.sleep(0.5)
# Motor(chip=output_lines, status=status, action='On')
# time.sleep(vent_duration)
# Motor(chip=output_lines, status=status, action='Off')
# time.sleep(0.5)
# Valve_Vent(chip=output_lines, status=status, action='Off')
# time.sleep(1)
# Vent and Clear sequence
# 1) Motor On
Motor(chip=output_lines, status=status, action='On')
time.sleep(0.5)
# 2) Input Pure Water
Valve_PureWater(chip=output_lines, status=status, action='On')
time.sleep(0.5)
Valve_EnterWater(chip=output_lines, status=status, action='On')
time.sleep(vent_holding)
# 3) Open Vent
Valve_Vent(chip=output_lines, status=status, action='On')
time.sleep(pure_duration)
Valve_PureWater(chip=output_lines, status=status, action='Off')
time.sleep(0.5)
# Valve_PureWater(chip=output_lines, status=status, action='On', duration=pure_duration)
Valve_PureWater(chip=output_lines, status=status, action='On')
time.sleep(step5_duration)
# Step 6. Drain mixed water
# Target valve status: [Motor: Off, Vent: On, Pure: On, Enter: Off, Main: Off]
Valve_EnterWater(chip=output_lines, status=status, action='Off')
time.sleep(step6_duration)
# Step 7. Input pure water and clean
# Target valve status: [Motor: On, Vent: Off, Pure: On, Enter: On, Main: Off]
# 4) Wait until empty
time.sleep(vent_duration)
# 5) Motor Off and Vent close
Motor(chip=output_lines, status=status, action='Off')
time.sleep(0.5)
Valve_Vent(chip=output_lines, status=status, action='Off')
time.sleep(0.5)
Valve_EnterWater(chip=output_lines, status=status, action='On')
time.sleep(0.5)
Motor(chip=output_lines, status=status, action='On')
time.sleep(step7_duration)
# Step 8. Drain pure Water
# Target valve status: [Motor: On, Vent: On, Pure: Off, Enter: Off, Main: Off]
Valve_Vent(chip=output_lines, status=status, action='On')
time.sleep(0.5)
Valve_EnterWater(chip=output_lines, status=status, action='Off')
time.sleep(0.5)
Valve_PureWater(chip=output_lines, status=status, action='Off')
time.sleep(step8_duration)
# Step 9. Stop moter
# Target valve status: [Motor: Off, Vent: On, Pure: Off, Enter: Off, Main: Off]
Motor(chip=output_lines, status=status, action='Off')
time.sleep(step9_duration)
return 1
elif cmd['type'] == 'clean':
logger.debug(f"[clean] duration: {int(cmd['maintenance']['clean']['duration'])}")
clean_system()
time.sleep(3)
else: # cmd['type'] == 'manual'
Motor(chip=output_lines, status=status, action=cmd['device']['motor']['action'])
Valve_Vent(chip=output_lines, status=status, action=cmd['device']['vent']['action'])
# Valve_MixedWater(chip=output_lines, status=status, action=cmd['device']['mixed']['action'])
# Valve_PureWater(chip=output_lines, status=status, action=cmd['device']['pure']['action'])
# Valve_EnterWater(chip=output_lines, status=status, action=cmd['device']['enter']['action'])
Valve_MainWater(chip=output_lines, status=status, action=cmd['device']['main']['action'])
Valve_MixedWater(chip=output_lines, status=status, action=cmd['device']['mixed']['action'])
Valve_PureWater(chip=output_lines, status=status, action=cmd['device']['pure']['action'])
Valve_EnterWater(chip=output_lines, status=status, action=cmd['device']['enter']['action'])
if cmd['device']['pure']['duration'] == 0:
Valve_PureWater(chip=output_lines, status=status, action=cmd['device']['pure']['action'])
else:
Valve_PureWater(chip=output_lines, status=status, action=cmd['device']['pure']['action'], duration=cmd['device']['pure']['duration'])
# if cmd['device']['main']['duration'] == 0:
# Valve_MainWater(chip=output_lines, status=status, action=cmd['device']['main']['action'])
# else:
# Valve_MainWater(chip=output_lines, status=status, action=cmd['device']['main']['action'], duration=cmd['device']['main']['duration'])
if cmd['device']['main']['duration'] == 0:
Valve_EnterWater(chip=output_lines, status=status, action=cmd['device']['enter']['action'])
else:
Valve_EnterWater(chip=output_lines, status=status, action=cmd['device']['enter']['action'], duration=cmd['device']['main']['duration'])
if cmd['device']['measure']['action'] == 'On':
result = Measure_Weight(client=client)
Calculate_Concentration(result)
@ -310,37 +192,6 @@ def Command_Read():
return 0
def clean_system():
global main_valve_status
with open('./control.json', 'r') as f:
cmd = json.load(f)
clean_duration = int(cmd['maintenance']['clean']['duration'])
if cmd['type'] == 'clean':
Valve_EnterWater(chip=output_lines, status=status, action='Off')
time.sleep(0.5)
Valve_MainWater(chip=output_lines, status=status, action='On')
time.sleep(0.5)
Valve_PureWater(chip=output_lines, status=status, action='On')
time.sleep(clean_duration)
Valve_MainWater(chip=output_lines, status=status, action='Off')
time.sleep(0.5)
Valve_EnterWater(chip=output_lines, status=status, action='On')
time.sleep(0.5)
Valve_Vent(chip=output_lines, status=status, action='On')
time.sleep(clean_duration)
Valve_PureWater(chip=output_lines, status=status, action='Off')
time.sleep(0.5)
Valve_Vent(chip=output_lines, status=status, action='Off')
time.sleep(0.5)
Valve_EnterWater(chip=output_lines, status=status, action='Off')
time.sleep(0.5)
def runAction():
# Write the app's actions in the "runAction" function.
@ -351,7 +202,6 @@ def runAction():
# 1. device-app-test -> Good
# 2. device-app-light-app -> Good
# 3. device-test-app -> Bad
global data
sdtcloud = sdtcloudnodeqmqtt.sdtcloudnodeqmqtt()
mqttClient1 = sdtcloud.setClient(f"device-app-1{uuid.uuid1()}") # parameter is client ID(string)
mqttClient2 = sdtcloud.setClient(f"device-app-2{uuid.uuid1()}") # parameter is client ID(string)
@ -365,8 +215,8 @@ def runAction():
# - Asset Code's variable: assetCode(string)
# - You may need it to create a topic.
cnt = 0
clean_flag = 0
while True:
start = time.time()
result = Command_Read()
@ -379,30 +229,13 @@ def runAction():
cnt = 0
end = time.time()
try:
now = datetime.now(pytz.timezone('Asia/Seoul'))
time_str = now.strftime('%H')
time_int = int(time_str)
with open('./control.json', 'r') as f:
cmd = json.load(f)
if time_int == int(cmd['maintenance']['clean']['time']):
if clean_flag < 3:
clean_flag += 1
clean_system()
else:
clean_flag = 0
except:
pass
diff = end - start
if diff < 3:
time.sleep(3 - diff)
def handle_client(conn, ip, port):
global data, logger
global data
while True:
try:
recv = conn.recv(100)
@ -425,8 +258,6 @@ def handle_client(conn, ip, port):
data_weight = '{:.3f}'.format(h_weight)
data_concent = '{:.3f}'.format(h_concentration)
logger.debug(f'TCP [R:Transfer data] weight: {data_weight}, concent: {data_concent}')
send_msg = 'STX' + time_str + '|' + data_weight + '|' + data_concent + 'ETX'
try:
@ -444,7 +275,6 @@ def handle_client(conn, ip, port):
conn.sendall(err_msg.encode("utf8"))
elif message[3] == 'S': # Start measurement
logger.debug(f'TCP [S:Start measurement]')
try:
with open('./control.json', 'r') as f:
cmd = json.load(f)
@ -459,26 +289,8 @@ def handle_client(conn, ip, port):
except Exception as e:
err_msg = 'STXERRORETX'
conn.sendall(err_msg.encode("utf8"))
elif message[3] == 'C': # Clean sequence
logger.debug(f'TCP [C:Clean sequence]')
try:
with open('./control.json', 'r') as f:
cmd = json.load(f)
cmd['type'] = 'clean'
with open('./control.json', 'w') as f:
json.dump(cmd, f, indent=4)
send_msg = 'STXOKETX'
conn.sendall(send_msg.encode("utf8"))
except Exception as e:
err_msg = 'STXERRORETX'
conn.sendall(err_msg.encode("utf8"))
elif message[3] == 'T': # Stop measurement
logger.debug(f'TCP [T:Stop measurement]')
try:
with open('./control.json', 'r') as f:
cmd = json.load(f)
@ -505,7 +317,7 @@ def handle_client(conn, ip, port):
# print("Closing the connection")
def start_server(addr, port):
host = addr # "172.17.16.201"
host = addr # "25.7.57.1"
port = port # 5000
soc = socket.socket(socket.AF_INET, socket.SOCK_STREAM)
@ -527,26 +339,18 @@ def start_server(addr, port):
client_handler.start()
soc.close()
def seoul_time(*args):
utc_dt = datetime.now()
seoul_tz = pytz.timezone('Asia/Seoul')
return utc_dt.replace(tzinfo=pytz.utc).astimezone(seoul_tz).timetuple()
def exit_handler(signum, frame):
Motor(chip=output_lines, status=status, action='Off')
Valve_Vent(chip=output_lines, status=status, action='Off')
# Valve_MixedWater(chip=output_lines, status=status, action='Off')
Valve_MixedWater(chip=output_lines, status=status, action='Off')
Valve_PureWater(chip=output_lines, status=status, action='Off')
Valve_EnterWater(chip=output_lines, status=status, action='Off')
Valve_MainWater(chip=output_lines, status=status, action='Off')
client.close()
sys.exit(0)
if __name__ == "__main__":
# Set GPIO
output_chip = gpiod.chip('gpiochip11')
config = gpiod.line_request()
config.consumer = 'output'
@ -557,40 +361,18 @@ if __name__ == "__main__":
status = [0, 0, 0, 0, 0, 0, 0, 0]
# When forced to terminate
signal.signal(signal.SIGINT, exit_handler)
# Set the logger
logger = logging.getLogger('sampyo_dio')
logger.setLevel(logging.DEBUG)
handler = RotatingFileHandler('/home/root/working.log', maxBytes=1024*1024, backupCount=3)
handler.setLevel(logging.DEBUG)
formatter = logging.Formatter('%(asctime)s - %(name)s - %(levelname)s - %(message)s')
formatter.converter = seoul_time
handler.setFormatter(formatter)
logger.addHandler(handler)
# Initialized valves
main_valve_status = 0
pure_valve_status = 0
Valve_MainWater(chip=output_lines, status=status, action='Off')
Valve_PureWater(chip=output_lines, status=status, action='Off')
# Read config file
with open('./config.json', encoding='UTF-8') as f:
jsonData = json.load(f)
# Set the weight of water in the chamber
volume_water = 1000.0 / float(jsonData['volume-water'])
# Set the IP address and port of NodeQ RS-232 module and activate TCP Client
modbus_addr = jsonData['modbus-server']['address']
modbus_port = jsonData['modbus-server']['port']
client = ModbusTcpClient(modbus_addr, modbus_port)
# Define the default data format
data = {
"timestamp": 0,
"data":{

View File