Add M666 'P' parameter