Half of the work for issue 4, c version

Signed-off-by: Mattias Andrée <maandree@operamail.com>