Изменения документа Управление шпинделем по Modbus на примере Toshiba VF-S11 и платы расширения PLCM-B1-G2

Сводка

• Вложения (0 изменено, 1 добавлено, 1 удалено)
  • modbus_spindle.zip
  • modbus_spindle.bm

Подробности

modbus_spindle.zip

Author

...	...	@@ -1,1 +1,0 @@
1		-XWiki.Knetyaga

Размер

...	...	@@ -1,1 +1,0 @@
1		-672 bytes

Содержимое

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