Updated the irsensor example for latest libnx, and various improvements.

This commit is contained in:
yellows8 2020-04-02 18:50:27 -04:00
parent 2e7d0c198e
commit 948ce48e58
No known key found for this signature in database
GPG Key ID: 0AF90DA3F1E60E43

View File

@ -49,27 +49,34 @@ int main(int argc, char **argv)
{ {
Result rc=0; Result rc=0;
const size_t ir_buffer_size = 0x12c00; const size_t ir_buffer_size = 0x12c00; // Size for the max IrsImageTransferProcessorFormat.
u8 *ir_buffer = NULL; u8 *ir_buffer = NULL;
ir_buffer = (u8*)malloc(ir_buffer_size); ir_buffer = (u8*)malloc(ir_buffer_size);
if (!ir_buffer) if (!ir_buffer) {
{
rc = MAKERESULT(Module_Libnx, LibnxError_OutOfMemory); rc = MAKERESULT(Module_Libnx, LibnxError_OutOfMemory);
return error_screen("Failed to allocate memory for ir_buffer.\n"); return error_screen("Failed to allocate memory for ir_buffer.\n");
} }
memset(ir_buffer, 0, ir_buffer_size); memset(ir_buffer, 0, ir_buffer_size);
rc = irsActivateIrsensor(1);
if (R_FAILED(rc))
return error_screen("irsActivateIrsensor() returned 0x%x\n", rc);
// Get the handle for the specified controller. // Get the handle for the specified controller.
u32 irhandle=0; IrsIrCameraHandle irhandle;
hidScanInput(); hidScanInput(); // Only needed because hidScanInput() was not used yet since this is before the main-loop, and we're using hidGetHandheldMode().
rc = irsGetIrCameraHandle(&irhandle, hidGetHandheldMode() ? CONTROLLER_HANDHELD : CONTROLLER_PLAYER_1); rc = irsGetIrCameraHandle(&irhandle, hidGetHandheldMode() ? CONTROLLER_HANDHELD : CONTROLLER_PLAYER_1);
if (R_FAILED(rc)) if (R_FAILED(rc))
return error_screen("irsGetIrCameraHandle() returned 0x%x\n", rc); return error_screen("irsGetIrCameraHandle() returned 0x%x\n", rc);
// If a controller update is needed, force an update.
bool updateflag=0;
rc = irsCheckFirmwareUpdateNecessity(irhandle, &updateflag);
if (R_SUCCEEDED(rc) && updateflag) {
HidLaControllerFirmwareUpdateArg updatearg;
hidLaCreateControllerFirmwareUpdateArg(&updatearg);
updatearg.enable_force_update = 1;
hidLaShowControllerFirmwareUpdate(&updatearg);
}
// Run the ImageTransferProcessor with the default config. The default uses the max IrsImageTransferProcessorFormat which has the slowest update-rate with irsGetImageTransferProcessorState. Hence, you may want to use a different IrsImageTransferProcessorFormat, or trim the image with irsRunImageTransferExProcessor.
IrsImageTransferProcessorConfig config; IrsImageTransferProcessorConfig config;
irsGetDefaultImageTransferProcessorConfig(&config); irsGetDefaultImageTransferProcessorConfig(&config);
rc = irsRunImageTransferProcessor(irhandle, &config, 0x100000); rc = irsRunImageTransferProcessor(irhandle, &config, 0x100000);
@ -80,40 +87,40 @@ int main(int argc, char **argv)
framebufferCreate(&fb, nwindowGetDefault(), FB_WIDTH, FB_HEIGHT, PIXEL_FORMAT_RGBA_8888, 2); framebufferCreate(&fb, nwindowGetDefault(), FB_WIDTH, FB_HEIGHT, PIXEL_FORMAT_RGBA_8888, 2);
framebufferMakeLinear(&fb); framebufferMakeLinear(&fb);
u64 sampling_number=0;
while (appletMainLoop()) while (appletMainLoop())
{ {
//Scan all the inputs. This should be done once for each frame // Scan all the inputs. This should be done once for each frame
hidScanInput(); hidScanInput();
//hidKeysDown returns information about which buttons have been just pressed (and they weren't in the previous frame) // hidKeysDown returns information about which buttons have been just pressed (and they weren't in the previous frame)
u64 kDown = hidKeysDown(CONTROLLER_P1_AUTO); u64 kDown = hidKeysDown(CONTROLLER_P1_AUTO);
if (kDown & KEY_PLUS) break; // break in order to return to hbmenu if (kDown & KEY_PLUS) break; // break in order to return to hbmenu
//Note that the image is updated every few seconds. Likewise, it takes a few seconds for the initial image to become available. // With the default config the image is updated every few seconds (see above). Likewise, it takes a few seconds for the initial image to become available.
//This will return an error when no image is available yet. // This will return an error when no image is available yet.
IrsImageTransferProcessorState state; IrsImageTransferProcessorState state;
rc = irsGetImageTransferProcessorState(irhandle, ir_buffer, ir_buffer_size, &state); rc = irsGetImageTransferProcessorState(irhandle, ir_buffer, ir_buffer_size, &state);
u32 stride; u32 stride;
u32* framebuf = (u32*)framebufferBegin(&fb, &stride); u32* framebuf = (u32*)framebufferBegin(&fb, &stride);
if (R_SUCCEEDED(rc)) if (R_SUCCEEDED(rc) && state.sampling_number != sampling_number) { // Only update framebuf when irsGetImageTransferProcessorState() is successful, where sampling_number changed.
{ sampling_number = state.sampling_number;
memset(framebuf, 0, stride*FB_HEIGHT); memset(framebuf, 0, stride*FB_HEIGHT);
//IR image width/height with the default config. // IR image width/height with the default config.
//The image is grayscale (1 byte per pixel / 8bits, with 1 color-component). // The image is grayscale (1 byte per pixel / 8bits, with 1 color-component).
const u32 ir_width = 240; const u32 ir_width = 320;
const u32 ir_height = 320; const u32 ir_height = 240;
u32 x, y; u32 x, y;
for (y=0; y<ir_height; y++)//Access the buffer linearly. for (y=0; y<ir_height; y++) { // Access the buffer linearly.
{ for (x=0; x<ir_width; x++) {
for (x=0; x<ir_width; x++)
{
u32 pos = y * stride/sizeof(u32) + x; u32 pos = y * stride/sizeof(u32) + x;
u32 pos2 = x * ir_height + y;//The IR image/camera is sideways with the joycon held flat. u32 pos2 = y * ir_width + x;//The IR image/camera is sideways with the joycon held flat. We won't rotate it here - you can do so yourself if you want.
framebuf[pos] = RGBA8_MAXALPHA(/*ir_buffer[pos2]*/0, ir_buffer[pos2], /*ir_buffer[pos2]*/0); framebuf[pos] = RGBA8_MAXALPHA(/*ir_buffer[pos2]*/0, ir_buffer[pos2], /*ir_buffer[pos2]*/0);
} }
} }