A method of implementing a model based servo controller in a digital signal processor in a disc drive includes obtaining matrices for a discrete-time state-space realization of the servo controller. Controller states of the controller are scaled to reduce a worst case bound on the controller states. The controller states are transformed to a desired format which reduces a number of required mathematical operations. Further, the matrices are converted to fixed point format.