Редактировал(а) Edgar Allan Poe 2024/02/29 12:05

От версии 16.1
отредактировано writer
на 2023/06/06 15:21
Изменить комментарий: Удаление файла modbus_spindle.bm
К версии 14.1
отредактировано writer
на 2023/01/27 12:02
Изменить комментарий: К данной версии нет комментариев

Сводка

Подробности

Свойства страницы
Содержимое
... ... @@ -30,7 +30,6 @@
30 30  
31 31  Рекомендуем использовать именно эти названия, так как в дальнейшем к регистрам будет обращение из фоновых операций по их именам.
32 32  
33 -(% class="non-break" %)
34 34  |=(% style="text-align:center" %)Название|=(% style="text-align:center" %)Мастер|=(% style="text-align:center" %)Адрес на шине|=(% style="text-align:center" %)Номер регистра|=(% style="text-align:center" %)Тип регистра
35 35  |SpindleMode|PLCM|1|64000|Output
36 36  |SpindleRPM|PLCM|1|64001|Output
modbus_spindle.bm
Author
... ... @@ -1,0 +1,1 @@
1 +XWiki.XWikiGuest
Размер
... ... @@ -1,0 +1,1 @@
1 +1.3 KB
Содержимое
... ... @@ -1,0 +1,52 @@
1 +function handle()
2 + local desired_rpm = GetCurSpindleRPM()
3 + if (not IsRealDeviceConnected()) then
4 + desired_rpm = 0
5 + end
6 +
7 + local value, is_online = ReadModbusRegisterUpdated("SpindleStatus")
8 + Sleep(30)
9 + local mode_updated = is_online and check_mode(value, desired_rpm)
10 +
11 + if (prev_rpm == nil or prev_rpm ~= desired_rpm or not mode_updated) then
12 + if (send_spindle_control_command(desired_rpm)) then
13 + prev_rpm = desired_rpm
14 + end
15 + end
16 +end
17 +
18 +function send_spindle_control_command(rpm)
19 + local mode = get_mode(rpm)
20 +
21 + local Hz = math.floor(math.abs(rpm) / 60 * 100 + 0.5)
22 +
23 + local success_1 = WriteModbusRegister("SpindleMode", mode)
24 + Sleep(30)
25 + local success_2 = WriteModbusRegister("SpindleRPM", Hz)
26 + return success_1 and success_2
27 +end
28 +
29 +function get_mode(rpm)
30 + local mode = 49152 -- Stop
31 + if (rpm > 0) then
32 + mode = 50176 -- Forward
33 + elseif (rpm < 0) then
34 + mode = 50688 -- Reverse
35 + end
36 +
37 + return mode
38 +end
39 +
40 +function check_mode(status, rpm)
41 + if (rpm > 0) then
42 + return is_bit_assigned(status, 10) and not is_bit_assigned(status, 9) -- Forward
43 + elseif (rpm < 0) then
44 + return is_bit_assigned(status, 10) and is_bit_assigned(status, 9) -- Reverse
45 + else
46 + return not is_bit_assigned(status, 10) -- Stop
47 + end
48 +end
49 +
50 +function is_bit_assigned(value, index)
51 + return value & (1 << index) ~= 0
52 +end