Add Sub method and fixed error in Normalize function