Added serial print + little fixes