Fix tests

Fixed some tests, still some are broke. Implementing a sinusoidal
system.