WaypointManager: WRITTING_WP retry implementation

TimeOut of WITTING_WP_COUNT
- DP will send waypoint size again

TimeOut of WRITTING_WP
- DP will send last waypoint sequence again