Add test code & add printfMutex