Added C1 code to aim 2b

This is not finished yet.