Did a little more testing, it was definitely rotating at max speed. I looked over the help file for the trajectory planner and I see you recommend inverse feedrate for rotary axis. I switched over to inverse feed and everything seems to be working fine. Code is a bit messy looking but it works. So everything is good as far as I know. Thanks again.
Mark