1 files changed, 56 insertions, 0 deletions

diff --git a/src/phenotypebinary.cpp b/src/phenotypebinary.cpp
index 0d32c9f..9d9e26c 100644
--- a/src/phenotypebinary.cpp
+++ b/src/phenotypebinary.cpp
@@ -18,6 +18,8 @@ Genetic::PhenotypeBinary::PhenotypeBinary( int iSize, bool bRandom ) :
         aGenes = new uint_fast32_t[iWords];
         if( bRandom )
                 randomize();
+        else
+                memset( aGenes, 0, sizeof(uint_fast32_t)*iWords );
 }
 
 Genetic::PhenotypeBinary::~PhenotypeBinary()
@@ -57,12 +59,16 @@ Genetic::Phenotype *Genetic::PhenotypeBinary::makeEmptyOffspring(
 Genetic::Phenotype &Genetic::PhenotypeBinary::copyFrom( const Phenotype &rSrc,
                 int iStart, int iCount, int iDest )
 {
+        if( iCount <= 0 )
+                return *this;
+
         const PhenotypeBinary &rbSrc =
                 dynamic_cast<const Genetic::PhenotypeBinary &>(rSrc);
         if( iDest < 0 )
                 iDest = iStart;
 
         // Fist draft, very sloppy: bit by bit copy, this is stupid, but easy
+        /*
         for( int j = 0; j < iCount; j++ )
         {
                 int wd = wordWithBit(j+iDest);
@@ -76,6 +82,56 @@ Genetic::Phenotype &Genetic::PhenotypeBinary::copyFrom( const Phenotype &rSrc,
                         aGenes[wd] |= (1<<((j+iDest)%BPW));
                 }
         }
+        */
+
+        {
+                if( iDest == iStart )
+                {
+                        if( wordWithBit(iStart) == wordWithBit(iStart+iCount-1) )
+                        {
+                                uint_fast32_t uMask = -1;
+                                uMask = (uMask << (iStart%BPW)) &
+                                        (uMask >> (BPW-(((iStart+iCount))%BPW)));
+//                              sio << Fmt().radix(2).width(32).fill('0') << uMask << sio.nl;
+                                aGenes[wordWithBit( iDest )] =
+                                        (aGenes[wordWithBit( iDest )]&(~uMask)) |
+                                        (rbSrc.aGenes[wordWithBit( iStart )]&uMask);
+                        }
+                        else
+                        {
+                                int iStartWord = wordWithBit( iStart );
+                                int iEndWord = wordWithBit( iStart+iCount );
+
+//                              sio << wordWithBit( iStart+iCount ) << "/" << iWords << sio.nl;
+//                              sio << iStart << " + " << iCount << " = "  << iStart+iCount << " / " << iSize << sio.nl;
+
+
+                                uint_fast32_t uMask = -1;
+                                uMask = uMask << (iStart%BPW);
+//                              sio << Fmt().radix(2).width(32).fill('0') << uMask << sio.nl;
+                                aGenes[wordWithBit( iDest )] =
+                                        (aGenes[wordWithBit( iDest )]&(~uMask)) |
+                                        (rbSrc.aGenes[wordWithBit( iStart )]&uMask);
+
+                                for( int j = iStartWord+1; j < iEndWord; j++ )
+                                        aGenes[j] = rbSrc.aGenes[j];
+                                
+                                uMask = ((uint_fast32_t)-1) >> (BPW-(((iStart+iCount))%BPW));
+//                              sio << Fmt().radix(2).width(32).fill('0') << uMask << sio.nl;
+                                aGenes[wordWithBit( iDest+iCount-1 )] =
+                                        (aGenes[wordWithBit( iDest+iCount-1 )]&(~uMask)) |
+                                        (rbSrc.aGenes[wordWithBit( iStart+iCount-1 )]&uMask);
+                        }
+                }
+                else if( iDest < iStart )
+                {
+                        sio << "iDest < iStart not finished." << sio.nl;
+                }
+                else
+                {
+                        sio << "iDest > iStart not finished." << sio.nl;
+                }
+        }       
 
         /*
         iStart%BPW