Welcome! Here are the website rules, as well as some tips for using this forum.
If you've found help here, check back in to let us know how everything worked out.
It's a great way to thank those who helped you.
I remember a heat pump setback stat that was supposed to learn how long it took to get back to the set point from its setback and start its ramp up in time to do it all without calling in the second stage. It was called something like "intelligent recovery". If its still out there it might do the trick for you.