mcu_atuc128l5har.c 8.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287
  1. /*
  2. * Copyright (C) 2012, Samsung Electronics Co. Ltd. All Rights Reserved.
  3. *
  4. * This program is free software; you can redistribute it and/or modify
  5. * it under the terms of the GNU General Public License as published by
  6. * the Free Software Foundation; either version 2 of the License, or
  7. * (at your option) any later version.
  8. *
  9. * This program is distributed in the hope that it will be useful,
  10. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  12. * GNU General Public License for more details.
  13. *
  14. */
  15. #include "../ssp.h"
  16. /*************************************************************************/
  17. /* factory Sysfs */
  18. /*************************************************************************/
  19. #define MODEL_NAME "ATUC128L5HAR"
  20. ssize_t mcu_revision_show(struct device *dev,
  21. struct device_attribute *attr, char *buf)
  22. {
  23. struct ssp_data *data = dev_get_drvdata(dev);
  24. return sprintf(buf, "AT01%u,AT01%u\n", get_module_rev(data),
  25. data->uCurFirmRev);
  26. }
  27. ssize_t mcu_model_name_show(struct device *dev,
  28. struct device_attribute *attr, char *buf)
  29. {
  30. return sprintf(buf, "%s\n", MODEL_NAME);
  31. }
  32. ssize_t mcu_update_kernel_bin_show(struct device *dev,
  33. struct device_attribute *attr, char *buf)
  34. {
  35. bool bSuccess = false;
  36. int iRet = 0;
  37. struct ssp_data *data = dev_get_drvdata(dev);
  38. ssp_dbg("[SSP]: %s - mcu binany update!\n", __func__);
  39. iRet = forced_to_download_binary(data, UMS_BINARY);
  40. if (iRet == SUCCESS) {
  41. bSuccess = true;
  42. goto out;
  43. }
  44. iRet = forced_to_download_binary(data, KERNEL_BINARY);
  45. if (iRet == SUCCESS)
  46. bSuccess = true;
  47. else
  48. bSuccess = false;
  49. out:
  50. return sprintf(buf, "%s\n", (bSuccess ? "OK" : "NG"));
  51. }
  52. ssize_t mcu_update_kernel_crashed_bin_show(struct device *dev,
  53. struct device_attribute *attr, char *buf)
  54. {
  55. bool bSuccess = false;
  56. int iRet = 0;
  57. struct ssp_data *data = dev_get_drvdata(dev);
  58. ssp_dbg("[SSP]: %s - mcu binany update!\n", __func__);
  59. iRet = forced_to_download_binary(data, UMS_BINARY);
  60. if (iRet == SUCCESS) {
  61. bSuccess = true;
  62. goto out;
  63. }
  64. iRet = forced_to_download_binary(data, KERNEL_CRASHED_BINARY);
  65. if (iRet == SUCCESS)
  66. bSuccess = true;
  67. else
  68. bSuccess = false;
  69. out:
  70. return sprintf(buf, "%s\n", (bSuccess ? "OK" : "NG"));
  71. }
  72. ssize_t mcu_update_ums_bin_show(struct device *dev,
  73. struct device_attribute *attr, char *buf)
  74. {
  75. bool bSuccess = false;
  76. int iRet = 0;
  77. struct ssp_data *data = dev_get_drvdata(dev);
  78. ssp_dbg("[SSP]: %s - mcu binany update!\n", __func__);
  79. iRet = forced_to_download_binary(data, UMS_BINARY);
  80. if (iRet == SUCCESS)
  81. bSuccess = true;
  82. else
  83. bSuccess = false;
  84. return sprintf(buf, "%s\n", (bSuccess ? "OK" : "NG"));
  85. }
  86. ssize_t mcu_reset_show(struct device *dev,
  87. struct device_attribute *attr, char *buf)
  88. {
  89. struct ssp_data *data = dev_get_drvdata(dev);
  90. reset_mcu(data);
  91. return sprintf(buf, "OK\n");
  92. }
  93. ssize_t mcu_factorytest_store(struct device *dev,
  94. struct device_attribute *attr, const char *buf, size_t size)
  95. {
  96. struct ssp_data *data = dev_get_drvdata(dev);
  97. char chTempBuf[2] = {0, 10};
  98. int iRet = 0;
  99. if (sysfs_streq(buf, "1")) {
  100. data->uFactorydataReady = 0;
  101. memset(data->uFactorydata, 0, sizeof(char) * FACTORY_DATA_MAX);
  102. data->bMcuIRQTestSuccessed = false;
  103. data->uTimeOutCnt = 0;
  104. iRet = send_instruction(data, FACTORY_MODE,
  105. MCU_FACTORY, chTempBuf, 2);
  106. if (data->uTimeOutCnt == 0)
  107. data->bMcuIRQTestSuccessed = true;
  108. } else {
  109. pr_err("[SSP]: %s - invalid value %d\n", __func__, *buf);
  110. return -EINVAL;
  111. }
  112. ssp_dbg("[SSP]: MCU Factory Test Start! - %d\n", iRet);
  113. return size;
  114. }
  115. ssize_t mcu_factorytest_show(struct device *dev,
  116. struct device_attribute *attr, char *buf)
  117. {
  118. bool bMcuTestSuccessed = false;
  119. struct ssp_data *data = dev_get_drvdata(dev);
  120. if (data->bSspShutdown == true) {
  121. ssp_dbg("[SSP]: %s - MCU Bin is crashed\n", __func__);
  122. return sprintf(buf, "NG,NG,NG\n");
  123. }
  124. if (data->uFactorydataReady & (1 << MCU_FACTORY)) {
  125. ssp_dbg("[SSP] MCU Factory Test Data : %u, %u, %u, %u, %u\n",
  126. data->uFactorydata[0], data->uFactorydata[1],
  127. data->uFactorydata[2], data->uFactorydata[3],
  128. data->uFactorydata[4]);
  129. /* system clock, RTC, I2C Master, I2C Slave, externel pin */
  130. if ((data->uFactorydata[0] == SUCCESS)
  131. && (data->uFactorydata[1] == SUCCESS)
  132. && (data->uFactorydata[2] == SUCCESS)
  133. && (data->uFactorydata[3] == SUCCESS)
  134. && (data->uFactorydata[4] == SUCCESS))
  135. bMcuTestSuccessed = true;
  136. } else {
  137. pr_err("[SSP]: %s - The Sensorhub is not ready %u\n", __func__,
  138. data->uFactorydataReady);
  139. }
  140. ssp_dbg("[SSP]: MCU Factory Test Result - %s, %s, %s\n", MODEL_NAME,
  141. (data->bMcuIRQTestSuccessed ? "OK" : "NG"),
  142. (bMcuTestSuccessed ? "OK" : "NG"));
  143. return sprintf(buf, "%s,%s,%s\n", MODEL_NAME,
  144. (data->bMcuIRQTestSuccessed ? "OK" : "NG"),
  145. (bMcuTestSuccessed ? "OK" : "NG"));
  146. }
  147. ssize_t mcu_sleep_factorytest_store(struct device *dev,
  148. struct device_attribute *attr, const char *buf, size_t size)
  149. {
  150. struct ssp_data *data = dev_get_drvdata(dev);
  151. char chTempBuf[2] = {0, 10};
  152. int iRet = 0;
  153. if (sysfs_streq(buf, "1")) {
  154. data->uFactorydataReady = 0;
  155. memset(data->uFactorydata, 0, sizeof(char) * FACTORY_DATA_MAX);
  156. iRet = send_instruction(data, FACTORY_MODE,
  157. MCU_SLEEP_FACTORY, chTempBuf, 2);
  158. } else {
  159. pr_err("[SSP]: %s - invalid value %d\n", __func__, *buf);
  160. return -EINVAL;
  161. }
  162. ssp_dbg("[SSP]: MCU Sleep Factory Test Start! - %d\n", iRet);
  163. return size;
  164. }
  165. ssize_t mcu_sleep_factorytest_show(struct device *dev,
  166. struct device_attribute *attr, char *buf)
  167. {
  168. int iDataIdx, iSensorData = 0;
  169. struct ssp_data *data = dev_get_drvdata(dev);
  170. struct sensor_value fsb[SENSOR_MAX];
  171. if (!(data->uFactorydataReady & (1 << MCU_SLEEP_FACTORY))) {
  172. pr_err("[SSP]: %s - The Sensorhub is not ready\n", __func__);
  173. goto exit;
  174. }
  175. /* if using this log, have to declare int i;
  176. for (i = 0; i < FACTORY_DATA_MAX; i++)
  177. pr_info("[SSP] %s: data->uFactorydata[%d] = 0x%X\n",
  178. __func__, i, data->uFactorydata[i]);
  179. */
  180. for (iDataIdx = 0; iDataIdx < FACTORY_DATA_MAX;) {
  181. iSensorData = (int)data->uFactorydata[iDataIdx++];
  182. if ((iSensorData < 0) ||
  183. (iSensorData >= (SENSOR_MAX - 1))) {
  184. pr_err("[SSP]: %s - Mcu data frame error %d\n",
  185. __func__, iSensorData);
  186. goto exit;
  187. }
  188. data->get_sensor_data[iSensorData]((char *)data->uFactorydata,
  189. &iDataIdx, &(fsb[iSensorData]));
  190. }
  191. convert_acc_data(&fsb[ACCELEROMETER_SENSOR].x);
  192. convert_acc_data(&fsb[ACCELEROMETER_SENSOR].y);
  193. convert_acc_data(&fsb[ACCELEROMETER_SENSOR].z);
  194. fsb[ACCELEROMETER_SENSOR].x -= data->accelcal.x;
  195. fsb[ACCELEROMETER_SENSOR].y -= data->accelcal.y;
  196. fsb[ACCELEROMETER_SENSOR].z -= data->accelcal.z;
  197. fsb[GYROSCOPE_SENSOR].x -= data->gyrocal.x;
  198. fsb[GYROSCOPE_SENSOR].y -= data->gyrocal.y;
  199. fsb[GYROSCOPE_SENSOR].z -= data->gyrocal.z;
  200. fsb[PRESSURE_SENSOR].pressure[0] -= data->iPressureCal;
  201. exit:
  202. ssp_dbg("[SSP]: %s Result\n"
  203. "accel %d,%d,%d\n"
  204. "gyro %d,%d,%d\n"
  205. "mag %d,%d,%d\n"
  206. "baro %d,%d\n"
  207. "ges %d,%d,%d,%d\n"
  208. "prox %u,%u\n"
  209. "temp %d,%d,%d\n"
  210. "light %u,%u,%u,%u\n", __func__,
  211. fsb[ACCELEROMETER_SENSOR].x, fsb[ACCELEROMETER_SENSOR].y,
  212. fsb[ACCELEROMETER_SENSOR].z, fsb[GYROSCOPE_SENSOR].x,
  213. fsb[GYROSCOPE_SENSOR].y, fsb[GYROSCOPE_SENSOR].z,
  214. fsb[GEOMAGNETIC_SENSOR].x, fsb[GEOMAGNETIC_SENSOR].y,
  215. fsb[GEOMAGNETIC_SENSOR].z, fsb[PRESSURE_SENSOR].pressure[0],
  216. fsb[PRESSURE_SENSOR].pressure[1],
  217. fsb[GESTURE_SENSOR].data[0], fsb[GESTURE_SENSOR].data[1],
  218. fsb[GESTURE_SENSOR].data[2], fsb[GESTURE_SENSOR].data[3],
  219. fsb[PROXIMITY_SENSOR].prox[0], fsb[PROXIMITY_SENSOR].prox[1],
  220. fsb[TEMPERATURE_HUMIDITY_SENSOR].data[0],
  221. fsb[TEMPERATURE_HUMIDITY_SENSOR].data[1],
  222. fsb[TEMPERATURE_HUMIDITY_SENSOR].data[2],
  223. fsb[LIGHT_SENSOR].r, fsb[LIGHT_SENSOR].g, fsb[LIGHT_SENSOR].b,
  224. fsb[LIGHT_SENSOR].w);
  225. return sprintf(buf, "%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%u,"
  226. "%u,%u,%u,%u,%d,%d,%d,%d,%d,%d\n",
  227. fsb[ACCELEROMETER_SENSOR].x, fsb[ACCELEROMETER_SENSOR].y,
  228. fsb[ACCELEROMETER_SENSOR].z, fsb[GYROSCOPE_SENSOR].x,
  229. fsb[GYROSCOPE_SENSOR].y, fsb[GYROSCOPE_SENSOR].z,
  230. fsb[GEOMAGNETIC_SENSOR].x, fsb[GEOMAGNETIC_SENSOR].y,
  231. fsb[GEOMAGNETIC_SENSOR].z, fsb[PRESSURE_SENSOR].pressure[0],
  232. fsb[PRESSURE_SENSOR].pressure[1], fsb[PROXIMITY_SENSOR].prox[1],
  233. fsb[LIGHT_SENSOR].r, fsb[LIGHT_SENSOR].g, fsb[LIGHT_SENSOR].b,
  234. fsb[LIGHT_SENSOR].w,
  235. fsb[GESTURE_SENSOR].data[0], fsb[GESTURE_SENSOR].data[1],
  236. fsb[GESTURE_SENSOR].data[2], fsb[GESTURE_SENSOR].data[3],
  237. fsb[TEMPERATURE_HUMIDITY_SENSOR].data[0],
  238. fsb[TEMPERATURE_HUMIDITY_SENSOR].data[1]);
  239. }