Implemented read_serial and finally got the set_setpoint method working!