fixed laser updating wrongly, fixed ctrl-c to close
Controller with PID