MODEL/usda-iot-tablets
13
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Compare commits

merge into: MODEL/usda-iot-tablets:jc
Branches Tags
MODEL/usda-iot-tablets:main MODEL/usda-iot-tablets:meyer MODEL/usda-iot-tablets:sheller MODEL/usda-iot-tablets:jc
..
pull from: MODEL/usda-iot-tablets:sheller
Branches Tags
MODEL/usda-iot-tablets:main MODEL/usda-iot-tablets:meyer MODEL/usda-iot-tablets:sheller MODEL/usda-iot-tablets:jc

1 Commits
jc .. sheller

Author SHA1 Message Date
biqu a8bfba6a77 Sheller MQTT app configuration 2024-09-24 16:30:31 -04:00
3 changed files with 111 additions and 527 deletions
Expand all files Collapse all files
MX64.json
-382
View File
@@ -1,382 +0,0 @@
{
"Protocol_1": {
"Control_Table": {
"Model_Number": [
0,
2
],
"Firmware_Version": [
2,
1
],
"ID": [
3,
1
],
"Baud_Rate": [
4,
1
],
"Return_Delay_Time": [
5,
1
],
"CW_Angle_Limit": [
6,
2
],
"CCW_Angle_Limit": [
8,
2
],
"Temperature_Limit": [
11,
1
],
"Min_Voltage_Limit": [
12,
1
],
"Max_Voltage_Limit": [
13,
1
],
"Max_Torque": [
14,
2
],
"Status_Return_Level": [
16,
1
],
"Alarm_LED": [
17,
1
],
"Shutdown": [
18,
1
],
"Multi_Turn_Offset": [
20,
2
],
"Resolution_Divider": [
22,
1
],
"Torque_Enable": [
24,
1
],
"LED": [
25,
1
],
"D_Gain": [
26,
1
],
"I_Gain": [
27,
1
],
"P_Gain": [
28,
1
],
"Goal_Position": [
30,
2
],
"Moving_Speed": [
32,
2
],
"Torque_Limit": [
34,
2
],
"Present_Position": [
36,
2
],
"Present_Speed": [
38,
2
],
"Present_Load": [
40,
2
],
"Present_Voltage": [
42,
1
],
"Present_Temperature": [
43,
1
],
"Registered": [
44,
1
],
"Moving": [
46,
1
],
"Lock": [
47,
1
],
"Punch": [
48,
2
],
"Realtime_Tick": [
50,
2
],
"Current": [
68,
2
],
"Torque_Ctrl_Mode_Enable": [
70,
1
],
"Goal_Torque": [
71,
2
],
"Goal_Acceleration": [
73,
1
]
},
"Values": {
"Min_Position": 0,
"Max_Position": 4095,
"Max_Angle": 360
}
},
"Protocol_2": {
"Control_Table": {
"Control_Table": {
"Model_Number": [
0,
2
],
"Model_Information": [
2,
4
],
"Firmware_Version": [
6,
1
],
"ID": [
7,
1
],
"Baud_Rate": [
8,
1
],
"Return_Delay_Time": [
9,
1
],
"Drive_Mode": [
10,
1
],
"Operating_Mode": [
11,
1
],
"Secondary_ID": [
12,
1
],
"Protocol_Type": [
13,
1
],
"Homing_Offset": [
20,
4
],
"Moving_Threshold": [
24,
4
],
"Temperature_Limit": [
31,
1
],
"Max_Voltage_Limit": [
32,
2
],
"Min_Voltage_Limit": [
34,
2
],
"PWM_Limit": [
36,
2
],
"Current_Limit": [
38,
2
],
"Acceleration_Limit": [
40,
4
],
"Velocity_Limit": [
44,
4
],
"Max_Position_Limit": [
48,
4
],
"Min_Position_Limit": [
52,
4
],
"Shutdown": [
63,
1
],
"Torque_Enable": [
64,
1
],
"LED": [
65,
1
],
"Return_Status_Level": [
68,
1
],
"Registered_Instruction": [
69,
1
],
"Hardware_Error_Status": [
70,
1
],
"Velocity_I_Gain": [
76,
2
],
"Velocity_P_Gain": [
78,
2
],
"Position_D_Gain": [
80,
2
],
"Position_I_Gain": [
82,
2
],
"Position_P_Gain": [
84,
2
],
"Feedforward_2nd_Gain": [
88,
2
],
"Feedforward_1st_Gain": [
90,
2
],
"BUS_Watchdog": [
98,
1
],
"Goal_PWM": [
100,
2
],
"Goal_Current": [
102,
2
],
"Goal_Velocity": [
104,
4
],
"Profile_Acceleration": [
108,
4
],
"Profile_Velocity": [
112,
4
],
"Goal_Position": [
116,
4
],
"Realtime_Tick": [
120,
2
],
"Moving": [
122,
1
],
"Moving_Status": [
123,
1
],
"Present_PWM": [
124,
2
],
"Present_Current": [
126,
2
],
"Present_Velocity": [
128,
4
],
"Present_Position": [
132,
4
],
"Velocity_Trajectory": [
136,
4
],
"Position_Trajectory": [
140,
4
],
"Present_Input_Voltage": [
144,
2
],
"Present_Temperature": [
146,
1
]
}
},
"Values:": {
"Min_Position": 0,
"Max_Position": 4095,
"Max_Angle": 360
}
}
}
XM540W270.json
-68
View File
@@ -1,68 +0,0 @@
{
"Protocol_2": {
"Control_Table": {
"Model_Number": [0, 2],
"Model_Information": [2, 4],
"Firmware_Version": [6, 1],
"ID": [7, 1],
"Baud_Rate": [8, 1],
"Return_Delay_Time": [9, 1],
"Drive_Mode": [10, 1],
"Operating_Mode": [11, 1],
"Secondary_Shadow_ID": [12, 1],
"Protocol_Type": [13, 1],
"Homing_Offset": [20, 4],
"Moving_Threshold": [24, 4],
"Temperature_Limit": [31, 1],
"Max_Voltage_Limit": [32, 2],
"Min_Voltage_Limit": [34, 2],
"PWM_Limit": [36, 2],
"Current_Limit": [38, 2],
"Velocity_Limit": [44, 4],
"Max_Position": [48, 4],
"Min_Position": [52, 4],
"External_Port_Mode_1": [56, 1],
"External_Port_Mode_2": [57, 1],
"External_Port_Mode_3": [58, 1],
"Startup_Configuration": [60, 1],
"Shutdown": [63, 1],
"Torque_Enable": [64, 1],
"LED": [65, 1],
"Status_Return_Level": [68, 1],
"Registered_Instruction": [69, 1],
"Hardware_Error_Status": [70, 1],
"Velocity_I_Gain": [76, 2],
"Velocity_P_Gain": [78, 2],
"Position_D_Gain": [80, 2],
"Position_I_Gain": [82, 2],
"Position_P_Gain": [84, 2],
"Feedforward_2nd_Gain": [88, 2],
"Feedforward_1st_Gain": [90, 2],
"Bus_Watchdog": [98, 1],
"Goal_PWM": [100, 2],
"Goal_Current": [102, 2],
"Goal_Velocity": [104, 4],
"Profile_Acceleration": [108, 4],
"Profile_Velocity": [112, 4],
"Goal_Position": [116, 4],
"Realtime_Tick": [120, 2],
"Moving": [122, 1],
"Moving_Status": [123, 1],
"Present_PWM": [124, 2],
"Present_Current": [126, 2],
"Present_Velocity": [128, 4],
"Present_Position": [132, 4],
"Velocity_Trajectory": [136, 4],
"Position_Trajectory": [140, 4],
"Present_Input_Voltage": [144, 2],
"Present_Temperature": [146, 1],
"Backup_Ready": [147, 1],
"External_Port_Data_1": [152, 2],
"External_Port_Data_2": [154, 2],
"External_Port_Data_3": [156, 2],
"Indirect_Address_1": [168, 2],
"Indirect_Address_2": [170, 2],
"Indirect_Address_3": [172, 2]
}
}
}
mqtt_listener.py
+111 -77
View File
@@ -1,88 +1,122 @@
import paho.mqtt.client as mqtt import paho.mqtt.client as mqtt
import re import serial
from dynio import *
import time import time
import threading
from statistics import mean
from collections import deque, Counter
# State variable to check if HOME is received before POS
home_received = False
dxl_io = []
feed_motor = None
def set_feed(num): class ShellerRPMDisplay:
global feed_motor mqtt_host = "172.22.112.94"
feed_motor.set_velocity(75)
feed_motor.torque_enable()
feed_motor.set_position(int(convert_to_ticks(num)))
def disable_torque(): COM_PORTS = [ "/dev/ttyACM0", "/dev/ttyUSB0" ]
global feed_motor buffer = ""
feed_motor.torque_disable() def init(self):
self.drum = 0
self.paddle = 0
try:
self.serials = [
serial.Serial(
self.COM_PORTS[1],
9600,
timeout=1,
stopbits=serial.STOPBITS_ONE,
bytesize=serial.EIGHTBITS
),
serial.Serial(
self.COM_PORTS[0],
9600,
timeout=1,
stopbits=serial.STOPBITS_ONE,
bytesize=serial.EIGHTBITS
)
]
self.mqtt_inform()
for s in self.serials:
s.write(bytearray("@D1\r\n", encoding='ascii'))
return True
except Exception as e:
print(e)
time.sleep(1)
if hasattr(self, "serials"):
del self.serials
return False
def convert_to_ticks(angle): def start(self):
# Define the input range self.isrunning = True
min_input = 0 self.mqtt_inform()
max_input = 90
# Define the output range def stop(self):
max_output = 1212 self.isrunning = False
min_output = max_output - 1024 if hasattr(self, "serials"):
try:
for serial in self.serials:
serial.close()
except:
pass
del self.serials
# Ensure the angle is within the input range def main(self):
angle = max(min(angle, max_input), min_input) while self.isrunning:
if not hasattr(self, "serials"):
self.init()
try:
for i, serial in enumerate(self.serials):
if serial.in_waiting > 0:
self.buffer += serial.read(serial.in_waiting).decode(
"utf-8"
)
print(self.buffer)
self.process_text(self.buffer[: self.buffer.index("\r")], i)
self.buffer = ""
except Exception as e:
print(e)
time.sleep(1)
# Perform the inverse linear transformation def mqtt_inform(self):
value = ((angle - min_input) / (max_input - min_input)) * (max_output - min_output) + min_output # Publish MQTT messages for Moisture Percentage
self.client = mqtt.Client()
self.client.connect(self.mqtt_host, 1883)
self.client.publish(
"homeassistant/sensor/sheller-paddle-rpm/config",
'{\
"name": "Paddle RPM", \
"state_topic": "homeassistant/sensor/sheller/state", \
"unit_of_measurement": "RPM", \
"value_template": "{{ value_json.paddle }}", \
"unique_id": "sheller-paddle-rpm", \
"device":{ \
"identifiers": ["shelling-machine"], \
"name": "Shelling Machine", \
"manufacturer": "ME&E" \
} \
}', retain=True
)
self.client.publish(
"homeassistant/sensor/sheller-drum-rpm/config",
'{\
"name": "Drum RPM", \
"state_topic": "homeassistant/sensor/sheller/state", \
"unit_of_measurement": "RPM", \
"value_template": "{{ value_json.drum }}", \
"unique_id": "sheller-drum-rpm", \
"device":{ \
"identifiers": ["shelling-machine"] \
} \
}', retain=True
)
return value def process_text(self, text, index):
print(text)
if index == 0:
self.paddle = text
elif index == 1:
self.drum = text
# The callback for when the client receives a CONNACK response from the server. self.client.publish(
def on_connect(client, userdata, flags, rc): "homeassistant/sensor/sheller/state",
print(f"Connected with result code {str(rc)}") '{"paddle": "%s", "drum": "%s"}'
% (self.paddle, self.drum), retain=True
# Subscribing in on_connect() means that if we lose the connection and )
# reconnect then subscriptions will be renewed.
client.subscribe("/jc/feed")
# Connect to Dynamixels
global dxl_io, feed_motor
dxl_io = dxl.DynamixelIO('/dev/ttyS0')
feed_motor = dxl_io.new_mx64(2, 2)
feed_motor.get_position()
# The callback for when a PUBLISH message is received from the server.
def on_message(client, userdata, msg):
global home_received, feed_motor
message = msg.payload.decode()
pos_num = float(message) # Extract the number from the message and convert to float
set_feed(pos_num)
# Define a function to continuously report the log
def continuous_log_reporting():
global feed_motor
while True:
if feed_motor:
client.publish("/jc/feed/log", (feed_motor.get_position() - 188) * 90 / 1024)
time.sleep(1) # Adjust the sleep time as needed
# Start the continuous log reporting in a separate thread
log_thread = threading.Thread(target=continuous_log_reporting)
log_thread.daemon = True
log_thread.start()
client = mqtt.Client()
client.on_connect = on_connect
client.on_message = on_message
# Connect to the broker
client.connect("192.168.1.1", 1883, 60)
# Blocking call that processes network traffic, dispatches callbacks and
# handles reconnecting.
client.loop_forever()
if __name__ == "__main__":
obj = ShellerRPMDisplay()
obj.start()
obj.main()