servochannel tests added, memory allocation error fixed(?)