finished porting bottom servo over too c++