Yes... Check in the Firmware Enhancements for Marlin folder. If you want that, it is already done....