Cleaned up some of the mess
First working model of the two layered bed structure:
The URDF to SDF conversion is not working. Will have to convert fixed joints to revolute with 0 limits
Working multilayered autobed. Still takes time for the pressure map to be generated and updated.