Stabilization Code Adaptation is done!

Stabilization code with complementary filter is adapted with our
hardware interfaces. Library chances will be done, also.