Modelling and optimal control of nanopositioning piezo stage