Firmware request: Tool Change Mode with enclosure lights left ON

Thank you for this piece of firmware.- This in combination with the macro mades it.
I have edited the macro, so toolchange is possible and a bit more comfortable now, unfortunately i am not able to keep the work origin if i run the macro…

YOU WILL LOOSE YOUR ACTUAL WORK ORIGIN!

G28 O F3000; Move home if needed
M1010 S3 P100; Turn the lights on
M82
G53 G1 X250 Z150 F5000; Actual Machine Coordinate System,- Move to X250 Z150 with Speed of F500
G4 P5000; Wait 5Sec, so you could be ready
M1999; restart the machine controller, this needs about 12sec

I have now recognized, the touchscreen has its problems about tool detection,- could we restart the touchscreen from the console as well?