3 Axis Gimbal use Arduino

Hi, i want to make 3 axis gimbal for my project. I use 3 servo motors and this Multiwii board:

Those board is Arduino based. There are 4 sensors, but i just use BMA180 accelerometer and ITG3205 Gyroscope for my 3 axis gimbal. The Multiwii board is coming with program, but the gimbal program is only for 2 Axis. Besides that, I want to make a program by my self from the beginning.

Is there anyone here who is experienced in making 3 axis gimbal? is there anything that can be a reference for me?

Thank You..