Update C328 functions to use new timeout code