Gazebo2: Separate formula for gazebo 2.2