]> git.donarmstrong.com Git - lilypond.git/blobdiff - lily/simple-spacer.cc
(transform_heads): replace
[lilypond.git] / lily / simple-spacer.cc
index 5a658657d668b3db107232207f773791b7023bfa..8e3de2cf766105bc90212fd99d2c465f003e7c61 100644 (file)
@@ -3,26 +3,27 @@
   
   source file of the GNU LilyPond music typesetter
   
-  (c) 1999--2003 Han-Wen Nienhuys <hanwen@cs.uu.nl>
+  (c) 1999--2004 Han-Wen Nienhuys <hanwen@cs.uu.nl>
 
   TODO:
   - add support for different stretch/shrink constants?
   
 */
-#include <stdio.h>
+
+#include "simple-spacer.hh"
+
+#include <cstdio>
 #include <math.h>
+
 #include <libc-extension.hh>   // isinf
 
-#include "simple-spacer.hh"
 #include "paper-column.hh"
 #include "spring.hh"
-#include "rod.hh"
 #include "warn.hh"
 #include "column-x-positions.hh"
 #include "spaceable-grob.hh"
 #include "dimensions.hh"
 
-
 /*
    A simple spacing constraint solver. The approach:
 
    Perhaps this is not a bad thing, because the 1st looks better anyway.  */
 
 
+/*
+
+  positive force = expanding, negative force = compressing.
+  
+*/
+
 Simple_spacer::Simple_spacer ()
 {
   /*
     Give an extra penalty for compression. Needed to avoid compressing
     tightly spaced lines.
   */
-  compression_penalty_b_ = false;
   active_count_ = 0;
   force_ = 0.;
-  indent_ =0.0;
+  indent_ = 0.0;
   default_space_ = 20 PT;
 }
 
@@ -102,7 +108,7 @@ Simple_spacer::add_rod (int l, int r, Real dist)
   Real block_force = c * block_stretch;
   force_ = force_ >? block_force;
 
-  for (int i=l; i < r; i++)
+  for (int i = l; i < r; i++)
     springs_[i].block_force_ = block_force >?
       springs_[i].block_force_ ;
 }
@@ -110,8 +116,8 @@ Simple_spacer::add_rod (int l, int r, Real dist)
 Real
 Simple_spacer::range_ideal_len (int l, int r)   const
 {
-  Real d =0.;
-  for (int i=l; i < r; i++)
+  Real d = 0.;
+  for (int i = l; i < r; i++)
     d += springs_[i].ideal_;
   return d;
 }
@@ -119,10 +125,10 @@ Simple_spacer::range_ideal_len (int l, int r)   const
 Real
 Simple_spacer::range_stiffness (int l, int r) const
 {
-  Real den =0.0;
-  for (int i=l; i < r; i++)
+  Real den = 0.0;
+  for (int i = l; i < r; i++)
     {
-      if (springs_[i].active_b_)
+      if (springs_[i].is_active_)
        den += 1 / springs_[i].hooke_;
     }
 
@@ -133,8 +139,8 @@ Real
 Simple_spacer::active_blocking_force () const
 {
   Real bf = - infinity_f; 
-  for (int i=0; i < springs_.size (); i++)
-    if (springs_[i].active_b_)
+  for (int i = 0; i < springs_.size (); i++)
+    if (springs_[i].is_active_)
       {
        bf = bf >? springs_[i].block_force_;
       }
@@ -144,24 +150,39 @@ Simple_spacer::active_blocking_force () const
 Real
 Simple_spacer::active_springs_stiffness () const
 {
-  Real den = 0.0;
-  for (int i=0; i < springs_.size (); i++)
-    if (springs_[i].active_b_)
-      {
-       den += 1 / springs_[i].hooke_;
-      }
-  return 1/den;
+  Real  stiff =  range_stiffness (0, springs_.size ());
+  if (isinf (stiff))
+    {
+      /*
+       all springs are inactive. Take the stiffness of the
+       latest spring to block.
+       */
+
+      Real max_block_force = -infinity_f;
+      int max_i = -1;
+      for (int i = 0; i < springs_.size (); i++)
+       {
+         if (springs_[i].block_force_ > max_block_force)
+           {
+             max_i = i;
+             max_block_force = springs_[i].block_force_;
+           }
+       }
+
+      stiff = springs_[max_i].hooke_;   
+    }
+  return stiff;
 }
 
 void
 Simple_spacer::set_active_states ()
 {
   /* float comparison is safe, since force is only copied.  */
-  for (int i=0 ; i <springs_.size (); i++)
-    if (springs_[i].active_b_
+  for (int i = 0 ; i <springs_.size (); i++)
+    if (springs_[i].is_active_
        && springs_[i].block_force_ >= force_)
       {
-       springs_[i].active_b_ = false;
+       springs_[i].is_active_ = false;
        active_count_ --; 
       }
 }   
@@ -169,15 +190,15 @@ Simple_spacer::set_active_states ()
 Real
 Simple_spacer::configuration_length () const
 {
-  Real l =0.;
-  for (int i=0; i < springs_.size (); i++)
+  Real l = 0.;
+  for (int i = 0; i < springs_.size (); i++)
     l += springs_[i].length (force_);
 
   return l;
 }
 
 bool
-Simple_spacer::active_b () const
+Simple_spacer::is_active () const
 {
   return active_count_; 
 }
@@ -185,14 +206,14 @@ Simple_spacer::active_b () const
 void
 Simple_spacer::my_solve_linelen ()
 {
-  while (active_b ())
+  while (is_active ())
     {
       force_ = active_blocking_force ();
       Real conf = configuration_length ();
 
       if (conf < line_len_)
        {
-         force_ += (line_len_  - conf) * active_springs_stiffness ();
+         force_ += (line_len_ - conf) * active_springs_stiffness ();
          break;
        }
       else
@@ -204,106 +225,140 @@ Simple_spacer::my_solve_linelen ()
 void
 Simple_spacer::my_solve_natural_len ()
 {
-  while (active_b ())
+  Real line_len_force = 0.0;
+  
+  while (is_active ())
     {
       force_ = active_blocking_force () >? 0.0;
+      Real conf = configuration_length ();
 
+      if (conf < line_len_)
+       {
+         line_len_force = force_
+           + (line_len_ - conf)
+           * active_springs_stiffness();
+       }
+      
       if (force_ < 1e-8) // ugh.,
        break;
       
       set_active_states ();
     }
+
+  force_ = line_len_force;
 }
 
-void
-Simple_spacer::add_columns (Link_array<Grob> const &icols)
+LY_DEFINE(ly_solve_spring_rod_problem, "ly:solve-spring-rod-problem",
+         4, 1, 0, (SCM springs, SCM rods, SCM length, SCM ragged),
+         "Solve a spring and rod problem for @var{count} objects, that "
+         "are connected by @var{count-1} springs, and an arbitrary number of rods "
+         "Springs have the format (ideal, hooke) and rods (idx1, idx2, distance) "
+         "@var{length} is a number, @var{ragged} a boolean "
+         "Return: a list containing the force (positive for stretching, "
+         "negative for compressing and #f for non-satisfied constraints) "
+         "followed by the @var{spring-count}+1 positions of the objects. "
+         )
 {
-  Link_array<Grob> cols(icols);
-  
-  for (int i =  cols.size (); i--;)
-    if (gh_pair_p (cols[i]->get_grob_property ("between-cols")))
-      {
-       loose_cols_.push (cols[i]);
-       cols.del (i);
-      }
+  int len = scm_ilength (springs);
+  if (len == 0)
+    return scm_list_2 (scm_from_double (0.0), scm_from_double (0.0));
   
-  spaced_cols_ = cols;
-  for (int i=0; i < cols.size () - 1; i++)
+  SCM_ASSERT_TYPE (len >= 0, springs, SCM_ARG1, __FUNCTION__, "list of springs");
+  SCM_ASSERT_TYPE (scm_ilength (rods) >= 0, rods, SCM_ARG2, __FUNCTION__, "list of rods");
+  SCM_ASSERT_TYPE (scm_is_number (length) || length == SCM_BOOL_F,
+                  length, SCM_ARG3, __FUNCTION__, "number or #f");
+
+
+  bool is_ragged = ragged == SCM_BOOL_T; 
+  Simple_spacer spacer; 
+  for (SCM s = springs; scm_is_pair (s); s = scm_cdr (s))
     {
-      Spring_smob *spring = 0;
+      Real ideal = scm_to_double (scm_caar (s));
+      Real hooke = scm_to_double (scm_cadar (s));
 
-      for (SCM s = cols[i]->get_grob_property ("ideal-distances");
-          !spring && gh_pair_p (s);
-          s = ly_cdr (s))
-       {
-         Spring_smob *sp = unsmob_spring (ly_car (s));
-         
-         
-         if (sp->other_ == cols[i+1])
-           spring = sp;
-       }
+      spacer.add_spring (ideal, hooke);
+    }
 
-      Spring_description desc;
-      if (spring)
-       {
-         desc.ideal_ = spring->distance_;
-         desc.hooke_ = spring->strength_;
-       }
-      else
-       {
-         programming_error (_f("No spring between column %d and next one",
-                               Paper_column::get_rank (cols[i])
-                               ));
-         desc.hooke_ = 1.0;
-         desc.ideal_ = default_space_;
+  for (SCM s = rods; scm_is_pair (s); s = scm_cdr (s))
+    {
+      SCM entry = scm_car (s);
+      int l = scm_to_int (scm_car (entry));
+      int r = scm_to_int (scm_cadr (entry));
+      entry = scm_cddr (entry);
+      
+      Real distance = scm_to_double (scm_car (entry));
+      spacer.add_rod (l, r, distance);
+    }
 
-         continue;
-       }
+  spacer.line_len_ = scm_to_double (length);
+      
+  if (is_ragged)
+    spacer.my_solve_natural_len ();
+  else
+    spacer.my_solve_linelen ();
 
-      if (!desc.sane_b ())
-       {
-         programming_error ("Insane spring found. Setting to unit spring.");
+  Array<Real> posns;
+  posns.push (0.0);
+  for (int i = 0; i < spacer.springs_.size(); i++)
+    {
+      Real l = spacer.springs_[i].length ((is_ragged) ? 0.0 : spacer.force_);
+      posns.push (posns.top() + l);
+    }
 
-         desc.hooke_ = 1.0;
-         desc.ideal_ = 1.0;
-       }
 
-      if (isinf (desc.hooke_))
-       {
-         desc.active_b_ = false;
-         springs_.push (desc);
-       }
-      else
-       {
-         desc.block_force_ = - desc.hooke_ * desc.ideal_; // block at distance 0
-         springs_.push (desc);
-      
-         active_count_ ++;
-       }
+    
+  SCM force_return = SCM_BOOL_F;
+  if (!isinf (spacer.force_)
+      && (spacer.is_active () || is_ragged))
+    {
+      force_return = scm_from_double (spacer.force_);
+    }
 
-      if (spring->expand_only_b_)
-       {
-         compression_penalty_b_ = true;
-       }
-      
+  if (is_ragged
+      && posns.top () > spacer.line_len_)
+    {
+      force_return = SCM_BOOL_F;
     }
-  
-  for (int i=0; i < cols.size () - 1; i++)
+
+  SCM retval = SCM_EOL;
+  for (int i = posns.size(); i--;)
     {
-      for (SCM s = Spaceable_grob::get_minimum_distances (cols[i]);
-          gh_pair_p (s); s = ly_cdr (s))
-       {
-         Grob * other = unsmob_grob (ly_caar (s));
-         int oi = cols.find_index (other);
-         if (oi >= 0)
-           {
-             add_rod (i, oi, gh_scm2double (ly_cdar (s)));
-           }
-       }
+      retval = scm_cons (scm_from_double (posns[i]), retval); 
     }
 
+  retval = scm_cons (force_return, retval);
+  return retval;  
+}
+         
+         
+/****************************************************************/
+
+Spring_description::Spring_description ()
+{
+  ideal_ = 0.0;
+  hooke_ = 0.0;
+  is_active_ = true;
+  block_force_ = 0.0;
+}
+
 
+bool
+Spring_description::is_sane () const
+{
+  return (hooke_ > 0)
+    && ideal_ > 0
+    && !isinf (ideal_) && !isnan (ideal_);
+}
+
+Real
+Spring_description::length (Real f) const
+{
+  if (!is_active_)
+    f = block_force_;
+  return ideal_ + f / hooke_ ;
 }
+/****************************************************************/
+
 
 /*
   
@@ -321,46 +376,43 @@ Simple_spacer::add_columns (Link_array<Grob> const &icols)
   
  */
 void
-Simple_spacer::solve (Column_x_positions *positions, bool ragged) 
+Simple_spacer_wrapper::solve (Column_x_positions *positions, bool ragged) 
 {
-  /*
-    TODO: should support natural length on only the last line.
-   */
-  ragged = ragged || (line_len_ < 0) ;
   if (ragged)
-    my_solve_natural_len ();
+    spacer_->my_solve_natural_len ();
   else
-    my_solve_linelen ();
-
-  
-  positions->force_ = force_;
-  if ((force_ < 0))
-    {
-
-      /*
-       We used to have a penalty for compression, no matter what, but that
-       fucked up wtk1-fugue2 (taking 3 full pages.)
+    spacer_->my_solve_linelen ();
 
-       maybe this should be tunable?
-       */
-      if (compression_penalty_b_)
-       ; //    positions->force_ *= 2; //  hmm.
-    }
+  positions->force_ = spacer_->force_;
   
-  positions->config_.push (indent_);
-  for (int i=0; i <springs_.size (); i++)
+  /*
+    We used to have a penalty for compression, no matter what, but that
+    fucked up wtk1-fugue2 (taking 3 full pages.)
+  */
+  positions->config_.push (spacer_->indent_);
+  for (int i = 0; i < spacer_->springs_.size (); i++)
     {
-      Real  l = springs_[i].length ((ragged) ? 0.0 : force_);
+      Real  l = spacer_->springs_[i].length ((ragged) ? 0.0 : spacer_->force_);
       positions->config_.push (positions->config_.top () + l);
       /*
        we have l>= 0 here, up to rounding errors 
       */
     }
+
+  /*
+    For raggedright, we must have a measure of music density: this is
+    to prevent lots of short lines (which all have force = 0).
+    */
+  if (ragged)
+    {
+      positions->satisfies_constraints_ = 
+       positions->config_.top () < spacer_->line_len_ ;
+    }
+  else
+    positions->satisfies_constraints_ = spacer_->is_active ();
+
   positions->cols_ = spaced_cols_;
   positions->loose_cols_ = loose_cols_;
-  
-  positions->satisfies_constraints_b_ = (line_len_ < 0) || active_b ();
-
 
   /*
     Check if breaking constraints are met.
@@ -369,45 +421,135 @@ Simple_spacer::solve (Column_x_positions *positions, bool ragged)
   int sz =  positions->cols_.size ();
   for (int i = sz; i--; )
     {
-      SCM p = positions->cols_[i]->get_grob_property( "penalty");
-      if (gh_number_p (p))
+      SCM p = positions->cols_[i]->get_property ( "penalty");
+      if (scm_is_number (p))
        {
-         if (gh_scm2double (p) < -9999)
+         if (scm_to_double (p) < -9999)
            break_satisfy = break_satisfy && (i == 0 || i == sz -1);
-         if (gh_scm2double (p) > 9999)
+         if (scm_to_double (p) > 9999)
            break_satisfy = break_satisfy && !(i == 0 || i == sz -1);
        }
       
     }
 
-  positions->satisfies_constraints_b_ =
-    positions->satisfies_constraints_b_ && break_satisfy;
+  positions->satisfies_constraints_ =
+    positions->satisfies_constraints_ && break_satisfy;
+}
+
+void
+Simple_spacer::add_spring (Real ideal, Real hooke)
+{
+  Spring_description desc;
+
+  desc.ideal_ = ideal;
+  desc.hooke_ = hooke;
+  if (!desc.is_sane ())
+    {
+      programming_error ("Insane spring found. Setting to unit spring.");
 
-  if (ragged && force_ < 0)
-    positions->satisfies_constraints_b_ = false;
+      desc.hooke_ = 1.0;
+      desc.ideal_ = 1.0;
+    }
+  
+  if (isinf (hooke))
+    {
+      desc.is_active_ = false;
+    }
+  else
+    {
+      /*
+       desc.is_active_ ? 
+      */
+      desc.block_force_ = - desc.hooke_ * desc.ideal_; // block at distance 0
+      
+      active_count_ ++;
+    }
+  springs_.push (desc);
 }
 
-/****************************************************************/
+static int
+compare_paper_column_rank (Grob  *const &a,
+                          Grob  *const &b)
+{
+  return Paper_column::get_rank (a) - Paper_column::get_rank (b); 
+}
 
-Spring_description::Spring_description ()
+void
+Simple_spacer_wrapper::add_columns (Link_array<Grob> const &icols)
 {
-  ideal_ =0.0;
-  hooke_ =0.0;
-  active_b_ = true;
-  block_force_ = 0.0;
+  Link_array<Grob> cols (icols);
+  
+  for (int i =  cols.size (); i--;)
+    if (scm_is_pair (cols[i]->get_property ("between-cols")))
+      {
+       loose_cols_.push (cols[i]);
+       cols.del (i);
+      }
+  
+  spaced_cols_ = cols;
+  for (int i = 0; i < cols.size () - 1; i++)
+    {
+      Spring_smob *spring = 0;
+
+      for (SCM s = cols[i]->get_property ("ideal-distances");
+          !spring && scm_is_pair (s);
+          s = scm_cdr (s))
+       {
+         Spring_smob *sp = unsmob_spring (scm_car (s));
+         
+         
+         if (sp->other_ == cols[i+1])
+           spring = sp;
+       }
+
+      if (!spring)
+       programming_error (_f ("No spring between column %d and next one",
+                              Paper_column::get_rank (cols[i])
+                              ));
+
+      Real ideal = (spring) ? spring->distance_ : spacer_->default_space_;
+      Real hooke = (spring) ? spring->strength_ : 1.0;
+       
+      spacer_->add_spring (ideal, hooke);
+    }
+  
+  for (int i = 0; i < cols.size () - 1; i++)
+    {
+      for (SCM s = Spaceable_grob::get_minimum_distances (cols[i]);
+          scm_is_pair (s); s = scm_cdr (s))
+       {
+         Grob * other = unsmob_grob (scm_caar (s));
+         int oi = binsearch_links (cols, other, &compare_paper_column_rank);
+         if (oi >= 0)
+           {
+             spacer_->add_rod (i, oi, scm_to_double (scm_cdar (s)));
+           }
+       }
+
+      if (i
+         && !to_boolean  (cols[i]->get_property ("allow-outside-line")))
+       {
+         Interval e = cols[i]->extent (cols[i], X_AXIS);
+         if (!e.is_empty())
+           {
+             spacer_->add_rod (i, cols.size()-1, e[RIGHT]);
+             spacer_->add_rod (0, i, e[LEFT]);
+           }
+       }
+    }
 }
 
+Simple_spacer_wrapper::Simple_spacer_wrapper ()
+{
+  spacer_ = new Simple_spacer ();
+}
 
-bool
-Spring_description::sane_b () const
+Simple_spacer_wrapper::~Simple_spacer_wrapper ()
 {
-  return (hooke_ > 0) &&  !isinf (ideal_) && !isnan (ideal_);
+  delete spacer_;
 }
 
-Real
-Spring_description::length (Real f) const
+
+Simple_spacer_wrapper::Simple_spacer_wrapper (Simple_spacer_wrapper const&)
 {
-  if (!active_b_)
-    f = block_force_;
-  return ideal_ + f / hooke_ ;
 }