added config header
pid controller works. still has to be calibrated