A New Control Algorithm for Bimorph