Camera Stabilization Gantry Sim, Simulink Model, Code - For dsPIC