Writing the code for a PIDSubystem in Java