Blob Blame Raw
/*********************************************************************/
/* Copyright 2009, 2010 The University of Texas at Austin.           */
/* All rights reserved.                                              */
/*                                                                   */
/* Redistribution and use in source and binary forms, with or        */
/* without modification, are permitted provided that the following   */
/* conditions are met:                                               */
/*                                                                   */
/*   1. Redistributions of source code must retain the above         */
/*      copyright notice, this list of conditions and the following  */
/*      disclaimer.                                                  */
/*                                                                   */
/*   2. Redistributions in binary form must reproduce the above      */
/*      copyright notice, this list of conditions and the following  */
/*      disclaimer in the documentation and/or other materials       */
/*      provided with the distribution.                              */
/*                                                                   */
/*    THIS  SOFTWARE IS PROVIDED  BY THE  UNIVERSITY OF  TEXAS AT    */
/*    AUSTIN  ``AS IS''  AND ANY  EXPRESS OR  IMPLIED WARRANTIES,    */
/*    INCLUDING, BUT  NOT LIMITED  TO, THE IMPLIED  WARRANTIES OF    */
/*    MERCHANTABILITY  AND FITNESS FOR  A PARTICULAR  PURPOSE ARE    */
/*    DISCLAIMED.  IN  NO EVENT SHALL THE UNIVERSITY  OF TEXAS AT    */
/*    AUSTIN OR CONTRIBUTORS BE  LIABLE FOR ANY DIRECT, INDIRECT,    */
/*    INCIDENTAL,  SPECIAL, EXEMPLARY,  OR  CONSEQUENTIAL DAMAGES    */
/*    (INCLUDING, BUT  NOT LIMITED TO,  PROCUREMENT OF SUBSTITUTE    */
/*    GOODS  OR  SERVICES; LOSS  OF  USE,  DATA,  OR PROFITS;  OR    */
/*    BUSINESS INTERRUPTION) HOWEVER CAUSED  AND ON ANY THEORY OF    */
/*    LIABILITY, WHETHER  IN CONTRACT, STRICT  LIABILITY, OR TORT    */
/*    (INCLUDING NEGLIGENCE OR OTHERWISE)  ARISING IN ANY WAY OUT    */
/*    OF  THE  USE OF  THIS  SOFTWARE,  EVEN  IF ADVISED  OF  THE    */
/*    POSSIBILITY OF SUCH DAMAGE.                                    */
/*                                                                   */
/* The views and conclusions contained in the software and           */
/* documentation are those of the authors and should not be          */
/* interpreted as representing official policies, either expressed   */
/* or implied, of The University of Texas at Austin.                 */
/*********************************************************************/

#include <stdio.h>
#include "common.h"

#ifndef USE_ALPHA
#define REAL_PART(a, b)  (a)
#define IMAGE_PART(a, b) (b)
#else
#define REAL_PART(a, b)  (alpha_r * (a) - alpha_i * (b))
#define IMAGE_PART(a, b) (alpha_i * (a) + alpha_r * (b))
#endif

#if defined(REAL_ONLY)
#define CMULT(a, b) (REAL_PART(a, b))
#elif defined(IMAGE_ONLY)
#define CMULT(a, b) (IMAGE_PART(a, b))
#else
#define CMULT(a, b) (REAL_PART(a, b) + IMAGE_PART(a, b))
#endif

int CNAME(BLASLONG m, BLASLONG n, FLOAT *a, BLASLONG lda,
#ifdef USE_ALPHA
	   FLOAT alpha_r, FLOAT alpha_i, 
#endif
	   FLOAT *b){

  BLASLONG i, j;

  FLOAT *a_offset, *a_offset1, *a_offset2, *a_offset3, *a_offset4;
  FLOAT *b_offset, *b_offset1, *b_offset2, *b_offset3;
  FLOAT a1, a2, a3, a4, a5, a6, a7, a8;

  a_offset   = a;
  b_offset   = b;

  lda *= 2;

  b_offset2  = b + m  * (n & ~3);
  b_offset3  = b + m  * (n & ~1);

  j = (m >> 2);
  if (j > 0){
    do{
      a_offset1  = a_offset;
      a_offset2  = a_offset1 + lda;
      a_offset3  = a_offset2 + lda;
      a_offset4  = a_offset3 + lda;
      a_offset  += 4 * lda;
      
      b_offset1  = b_offset;
      b_offset  += 16;

      i = (n >> 2);
      if (i > 0){
	do{

	  a1 = *(a_offset1 + 0);
	  a2 = *(a_offset1 + 1);
	  a3 = *(a_offset1 + 2);
	  a4 = *(a_offset1 + 3);
	  a5 = *(a_offset1 + 4);
	  a6 = *(a_offset1 + 5);
	  a7 = *(a_offset1 + 6);
	  a8 = *(a_offset1 + 7);

	  *(b_offset1 +  0) = CMULT(a1, a2);
	  *(b_offset1 +  1) = CMULT(a3, a4);
	  *(b_offset1 +  2) = CMULT(a5, a6);
	  *(b_offset1 +  3) = CMULT(a7, a8);

	  a1 = *(a_offset2 + 0);
	  a2 = *(a_offset2 + 1);
	  a3 = *(a_offset2 + 2);
	  a4 = *(a_offset2 + 3);
	  a5 = *(a_offset2 + 4);
	  a6 = *(a_offset2 + 5);
	  a7 = *(a_offset2 + 6);
	  a8 = *(a_offset2 + 7);

	  *(b_offset1 +  4) = CMULT(a1, a2);
	  *(b_offset1 +  5) = CMULT(a3, a4);
	  *(b_offset1 +  6) = CMULT(a5, a6);
	  *(b_offset1 +  7) = CMULT(a7, a8);

	  a1 = *(a_offset3 + 0);
	  a2 = *(a_offset3 + 1);
	  a3 = *(a_offset3 + 2);
	  a4 = *(a_offset3 + 3);
	  a5 = *(a_offset3 + 4);
	  a6 = *(a_offset3 + 5);
	  a7 = *(a_offset3 + 6);
	  a8 = *(a_offset3 + 7);

	  *(b_offset1 +  8) = CMULT(a1, a2);
	  *(b_offset1 +  9) = CMULT(a3, a4);
	  *(b_offset1 + 10) = CMULT(a5, a6);
	  *(b_offset1 + 11) = CMULT(a7, a8);

	  a1 = *(a_offset4 + 0);
	  a2 = *(a_offset4 + 1);
	  a3 = *(a_offset4 + 2);
	  a4 = *(a_offset4 + 3);
	  a5 = *(a_offset4 + 4);
	  a6 = *(a_offset4 + 5);
	  a7 = *(a_offset4 + 6);
	  a8 = *(a_offset4 + 7);

	  *(b_offset1 + 12) = CMULT(a1, a2);
	  *(b_offset1 + 13) = CMULT(a3, a4);
	  *(b_offset1 + 14) = CMULT(a5, a6);
	  *(b_offset1 + 15) = CMULT(a7, a8);

	  a_offset1 += 8;
	  a_offset2 += 8;
	  a_offset3 += 8;
	  a_offset4 += 8;
	  
	  b_offset1 += m * 4;
	  i --;
	}while(i > 0);
      }

      if (n & 2) {

	a1 = *(a_offset1 + 0);
	a2 = *(a_offset1 + 1);
	a3 = *(a_offset1 + 2);
	a4 = *(a_offset1 + 3);
	a5 = *(a_offset2 + 0);
	a6 = *(a_offset2 + 1);
	a7 = *(a_offset2 + 2);
	a8 = *(a_offset2 + 3);
	
	*(b_offset2 +  0) = CMULT(a1, a2);
	*(b_offset2 +  1) = CMULT(a3, a4);
	*(b_offset2 +  2) = CMULT(a5, a6);
	*(b_offset2 +  3) = CMULT(a7, a8);
	
	a1 = *(a_offset3 + 0);
	a2 = *(a_offset3 + 1);
	a3 = *(a_offset3 + 2);
	a4 = *(a_offset3 + 3);
	a5 = *(a_offset4 + 0);
	a6 = *(a_offset4 + 1);
	a7 = *(a_offset4 + 2);
	a8 = *(a_offset4 + 3);
	
	*(b_offset2 +  4) = CMULT(a1, a2);
	*(b_offset2 +  5) = CMULT(a3, a4);
	*(b_offset2 +  6) = CMULT(a5, a6);
	*(b_offset2 +  7) = CMULT(a7, a8);
	
	a_offset1 += 4;
	a_offset2 += 4;
	a_offset3 += 4;
	a_offset4 += 4;
	
	b_offset2 += 8;
      }

      if (n & 1) {

	a1 = *(a_offset1 + 0);
	a2 = *(a_offset1 + 1);
	a3 = *(a_offset2 + 0);
	a4 = *(a_offset2 + 1);
	a5 = *(a_offset3 + 0);
	a6 = *(a_offset3 + 1);
	a7 = *(a_offset4 + 0);
	a8 = *(a_offset4 + 1);

	*(b_offset3 +  0) = CMULT(a1, a2);
	*(b_offset3 +  1) = CMULT(a3, a4);
	*(b_offset3 +  2) = CMULT(a5, a6);
	*(b_offset3 +  3) = CMULT(a7, a8);
	
	b_offset3 += 4;
      }

      j--;
    }while(j > 0);
  }

  if (m & 2){
    a_offset1  = a_offset;
    a_offset2  = a_offset1 + lda;
    a_offset  += 2 * lda;
    
    b_offset1  = b_offset;
    b_offset  += 8;
    
    i = (n >> 2);
    if (i > 0){
      do{

	a1 = *(a_offset1 + 0);
	a2 = *(a_offset1 + 1);
	a3 = *(a_offset1 + 2);
	a4 = *(a_offset1 + 3);
	a5 = *(a_offset1 + 4);
	a6 = *(a_offset1 + 5);
	a7 = *(a_offset1 + 6);
	a8 = *(a_offset1 + 7);
	
	*(b_offset1 +  0) = CMULT(a1, a2);
	*(b_offset1 +  1) = CMULT(a3, a4);
	*(b_offset1 +  2) = CMULT(a5, a6);
	*(b_offset1 +  3) = CMULT(a7, a8);
	
	a1 = *(a_offset2 + 0);
	a2 = *(a_offset2 + 1);
	a3 = *(a_offset2 + 2);
	a4 = *(a_offset2 + 3);
	a5 = *(a_offset2 + 4);
	a6 = *(a_offset2 + 5);
	a7 = *(a_offset2 + 6);
	a8 = *(a_offset2 + 7);
	
	*(b_offset1 +  4) = CMULT(a1, a2);
	*(b_offset1 +  5) = CMULT(a3, a4);
	*(b_offset1 +  6) = CMULT(a5, a6);
	*(b_offset1 +  7) = CMULT(a7, a8);
	
	a_offset1 += 8;
	a_offset2 += 8;
	
	b_offset1 += m * 4;
	i --;
      }while(i > 0);
    }

    if (n & 2) {
      a1 = *(a_offset1 + 0);
      a2 = *(a_offset1 + 1);
      a3 = *(a_offset1 + 2);
      a4 = *(a_offset1 + 3);
      a5 = *(a_offset2 + 0);
      a6 = *(a_offset2 + 1);
      a7 = *(a_offset2 + 2);
      a8 = *(a_offset2 + 3);
      
      *(b_offset2 +  0) = CMULT(a1, a2);
      *(b_offset2 +  1) = CMULT(a3, a4);
      *(b_offset2 +  2) = CMULT(a5, a6);
      *(b_offset2 +  3) = CMULT(a7, a8);
      
      a_offset1 += 4;
      a_offset2 += 4;
      b_offset2 += 4;
    }
    
    if (n & 1) {
      a1 = *(a_offset1 + 0);
      a2 = *(a_offset1 + 1);
      a3 = *(a_offset2 + 0);
      a4 = *(a_offset2 + 1);
      
      *(b_offset3 +  0) = CMULT(a1, a2);
      *(b_offset3 +  1) = CMULT(a3, a4);

      b_offset3 += 2;
    }
  }

  if (m & 1){
    a_offset1  = a_offset;
    b_offset1  = b_offset;
    
    i = (n >> 2);
    if (i > 0){
      do{
	a1 = *(a_offset1 + 0);
	a2 = *(a_offset1 + 1);
	a3 = *(a_offset1 + 2);
	a4 = *(a_offset1 + 3);
	a5 = *(a_offset1 + 4);
	a6 = *(a_offset1 + 5);
	a7 = *(a_offset1 + 6);
	a8 = *(a_offset1 + 7);
	
	*(b_offset1 +  0) = CMULT(a1, a2);
	*(b_offset1 +  1) = CMULT(a3, a4);
	*(b_offset1 +  2) = CMULT(a5, a6);
	*(b_offset1 +  3) = CMULT(a7, a8);
	
	a_offset1 += 8;

	b_offset1 += 4 * m;

	i --;
      }while(i > 0);
    }

    if (n & 2) {
      a1 = *(a_offset1 + 0);
      a2 = *(a_offset1 + 1);
      a3 = *(a_offset1 + 2);
      a4 = *(a_offset1 + 3);
      
      *(b_offset2 +  0) = CMULT(a1, a2);
      *(b_offset2 +  1) = CMULT(a3, a4);
      
      a_offset1 += 4;
    }
    
    if (n & 1) {
      a1 = *(a_offset1 + 0);
      a2 = *(a_offset1 + 1);
      
      *(b_offset3 +  0) = CMULT(a1, a2);
    }
  }

  return 0;
}