Lie Theory Based Optimization for Unified State Planning of Mobile Manipulators