Fix M500 and M503 for PID values M301