rocket stabilization code

uses the dimentions from the rocket fins and the rocket body to make micro adjustments using a 6 DoF sensor. this will be mainly used to control roll. but i also want it to function as a waypoint guidance system