FreeRTOSがいるのに無視してすべてをwhile(true)のなかでやってくの非常に微妙な感じあるが、わざわざ書き替える理由もなく、 

 @3472adfe 目的が達成出来てればよし！