Not sure how helpfull this will be,
For some (most?) Fanuc machines it is not wise to move in Z with CRC active, i would turn CRC on and off inside the Sub, moving to and from depth before and after calling the Sub. Also another couple of CRC "Rules" were must turn on and off with a move (between 90 and 180 degrees to profile) and the move should be larger than the rad of the cutter.
These were unbreakable rules on older machine controls, so rules i have always used - only just started using mach so not 100% sure in this case.
Good use of incremental, alternative would be a datum shift, have to watch out for carried errors with inc.