added sproing code
Started switching to angles for pendula.