Bug fixing

Works with 1st test vector (all 0's)